drivers/regulator/da903x.c

   1 /*
   2  * Regulators driver for Dialog Semiconductor DA903x
   3  *
   4  * Copyright (C) 2006-2008 Marvell International Ltd.
   5  * Copyright (C) 2008 Compulab Ltd.
   6  *
   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.
  10  */
  11
  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>
  19
  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)
  43
  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)
  66
  67 /* DA9035 Registers. DA9034 Registers are comptabile to DA9035. */
  68 #define DA9035_OVER3            (0x12)
  69 #define DA9035_VCC2             (0x1f)
  70 #define DA9035_3DTV1            (0x2c)
  71 #define DA9035_3DTV2            (0x2d)
  72 #define DA9035_3VRC             (0x2e)
  73 #define DA9035_AUTOSKIP         (0x2f)
  74
  75 struct da903x_regulator_info {
  76         struct regulator_desc desc;
  77
  78         int     min_uV;
  79         int     max_uV;
  80         int     step_uV;
  81         int     vol_reg;
  82         int     vol_shift;
  83         int     vol_nbits;
  84         int     update_reg;
  85         int     update_bit;
  86         int     enable_reg;
  87         int     enable_bit;
  88 };
  89
  90 static int da9034_ldo12_data[] = { 1700, 1750, 1800, 1850, 1900, 1950,
  91                                    2000, 2050, 2700, 2750, 2800, 2850,
  92                                    2900, 2950, 3000, 3050 };
  93
  94 static inline struct device *to_da903x_dev(struct regulator_dev *rdev)
  95 {
  96         return rdev_get_dev(rdev)->parent->parent;
  97 }
  98
  99 static inline int check_range(struct da903x_regulator_info *info,
 100                                 int min_uV, int max_uV)
 101 {
 102         if (min_uV < info->min_uV || min_uV > info->max_uV)
 103                 return -EINVAL;
 104
 105         return 0;
 106 }
 107
 108 /* DA9030/DA9034 common operations */
 109 static int da903x_set_ldo_voltage(struct regulator_dev *rdev,
 110                                   int min_uV, int max_uV)
 111 {
 112         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 113         struct device *da9034_dev = to_da903x_dev(rdev);
 114         uint8_t val, mask;
 115
 116         if (check_range(info, min_uV, max_uV)) {
 117                 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
 118                 return -EINVAL;
 119         }
 120
 121         val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
 122         val <<= info->vol_shift;
 123         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 124
 125         return da903x_update(da9034_dev, info->vol_reg, val, mask);
 126 }
 127
 128 static int da903x_get_voltage(struct regulator_dev *rdev)
 129 {
 130         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 131         struct device *da9034_dev = to_da903x_dev(rdev);
 132         uint8_t val, mask;
 133         int ret;
 134
 135         ret = da903x_read(da9034_dev, info->vol_reg, &val);
 136         if (ret)
 137                 return ret;
 138
 139         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 140         val = (val & mask) >> info->vol_shift;
 141
 142         return info->min_uV + info->step_uV * val;
 143 }
 144
 145 static int da903x_enable(struct regulator_dev *rdev)
 146 {
 147         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 148         struct device *da9034_dev = to_da903x_dev(rdev);
 149
 150         return da903x_set_bits(da9034_dev, info->enable_reg,
 151                                         1 << info->enable_bit);
 152 }
 153
 154 static int da903x_disable(struct regulator_dev *rdev)
 155 {
 156         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 157         struct device *da9034_dev = to_da903x_dev(rdev);
 158
 159         return da903x_clr_bits(da9034_dev, info->enable_reg,
 160                                         1 << info->enable_bit);
 161 }
 162
 163 static int da903x_is_enabled(struct regulator_dev *rdev)
 164 {
 165         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 166         struct device *da9034_dev = to_da903x_dev(rdev);
 167         uint8_t reg_val;
 168         int ret;
 169
 170         ret = da903x_read(da9034_dev, info->enable_reg, &reg_val);
 171         if (ret)
 172                 return ret;
 173
 174         return !!(reg_val & (1 << info->enable_bit));
 175 }
 176
 177 static int da903x_list_voltage(struct regulator_dev *rdev, unsigned selector)
 178 {
 179         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 180         int ret;
 181
 182         ret = info->min_uV + info->step_uV * selector;
 183         if (ret > info->max_uV)
 184                 return -EINVAL;
 185         return ret;
 186 }
 187
 188 /* DA9030 specific operations */
 189 static int da9030_set_ldo1_15_voltage(struct regulator_dev *rdev,
 190                                        int min_uV, int max_uV)
 191 {
 192         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 193         struct device *da903x_dev = to_da903x_dev(rdev);
 194         uint8_t val, mask;
 195         int ret;
 196
 197         if (check_range(info, min_uV, max_uV)) {
 198                 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
 199                 return -EINVAL;
 200         }
 201
 202         val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
 203         val <<= info->vol_shift;
 204         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 205         val |= DA9030_LDO_UNLOCK; /* have to set UNLOCK bits */
 206         mask |= DA9030_LDO_UNLOCK_MASK;
 207
 208         /* write twice */
 209         ret = da903x_update(da903x_dev, info->vol_reg, val, mask);
 210         if (ret)
 211                 return ret;
 212
 213         return da903x_update(da903x_dev, info->vol_reg, val, mask);
 214 }
 215
 216 static int da9030_set_ldo14_voltage(struct regulator_dev *rdev,
 217                                   int min_uV, int max_uV)
 218 {
 219         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 220         struct device *da903x_dev = to_da903x_dev(rdev);
 221         uint8_t val, mask;
 222         int thresh;
 223
 224         if (check_range(info, min_uV, max_uV)) {
 225                 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
 226                 return -EINVAL;
 227         }
 228
 229         thresh = (info->max_uV + info->min_uV) / 2;
 230         if (min_uV < thresh) {
 231                 val = (thresh - min_uV + info->step_uV - 1) / info->step_uV;
 232                 val |= 0x4;
 233         } else {
 234                 val = (min_uV - thresh + info->step_uV - 1) / info->step_uV;
 235         }
 236
 237         val <<= info->vol_shift;
 238         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 239
 240         return da903x_update(da903x_dev, info->vol_reg, val, mask);
 241 }
 242
 243 static int da9030_get_ldo14_voltage(struct regulator_dev *rdev)
 244 {
 245         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 246         struct device *da903x_dev = to_da903x_dev(rdev);
 247         uint8_t val, mask;
 248         int ret;
 249
 250         ret = da903x_read(da903x_dev, info->vol_reg, &val);
 251         if (ret)
 252                 return ret;
 253
 254         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 255         val = (val & mask) >> info->vol_shift;
 256
 257         if (val & 0x4)
 258                 return info->min_uV + info->step_uV * (3 - (val & ~0x4));
 259         else
 260                 return (info->max_uV + info->min_uV) / 2 +
 261                         info->step_uV * (val & ~0x4);
 262 }
 263
 264 /* DA9034 specific operations */
 265 static int da9034_set_dvc_voltage(struct regulator_dev *rdev,
 266                                   int min_uV, int max_uV)
 267 {
 268         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 269         struct device *da9034_dev = to_da903x_dev(rdev);
 270         uint8_t val, mask;
 271         int ret;
 272
 273         if (check_range(info, min_uV, max_uV)) {
 274                 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
 275                 return -EINVAL;
 276         }
 277
 278         val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
 279         val <<= info->vol_shift;
 280         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 281
 282         ret = da903x_update(da9034_dev, info->vol_reg, val, mask);
 283         if (ret)
 284                 return ret;
 285
 286         ret = da903x_set_bits(da9034_dev, info->update_reg,
 287                                         1 << info->update_bit);
 288         return ret;
 289 }
 290
 291 static int da9034_set_ldo12_voltage(struct regulator_dev *rdev,
 292                                     int min_uV, int max_uV)
 293 {
 294         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 295         struct device *da9034_dev = to_da903x_dev(rdev);
 296         uint8_t val, mask;
 297
 298         if (check_range(info, min_uV, max_uV)) {
 299                 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
 300                 return -EINVAL;
 301         }
 302
 303         val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
 304         val = (val >= 20) ? val - 12 : ((val > 7) ? 8 : val);
 305         val <<= info->vol_shift;
 306         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 307
 308         return da903x_update(da9034_dev, info->vol_reg, val, mask);
 309 }
 310
 311 static int da9034_get_ldo12_voltage(struct regulator_dev *rdev)
 312 {
 313         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 314         struct device *da9034_dev = to_da903x_dev(rdev);
 315         uint8_t val, mask;
 316         int ret;
 317
 318         ret = da903x_read(da9034_dev, info->vol_reg, &val);
 319         if (ret)
 320                 return ret;
 321
 322         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 323         val = (val & mask) >> info->vol_shift;
 324
 325         if (val >= 8)
 326                 return 2700000 + info->step_uV * (val - 8);
 327
 328         return info->min_uV + info->step_uV * val;
 329 }
 330
 331 static int da9034_list_ldo12_voltage(struct regulator_dev *rdev,
 332                                      unsigned selector)
 333 {
 334         if (selector > ARRAY_SIZE(da9034_ldo12_data))
 335                 return -EINVAL;
 336         return da9034_ldo12_data[selector] * 1000;
 337 }
 338
 339 static struct regulator_ops da903x_regulator_ldo_ops = {
 340         .set_voltage    = da903x_set_ldo_voltage,
 341         .get_voltage    = da903x_get_voltage,
 342         .list_voltage   = da903x_list_voltage,
 343         .enable         = da903x_enable,
 344         .disable        = da903x_disable,
 345         .is_enabled     = da903x_is_enabled,
 346 };
 347
 348 /* NOTE: this is dedicated for the insane DA9030 LDO14 */
 349 static struct regulator_ops da9030_regulator_ldo14_ops = {
 350         .set_voltage    = da9030_set_ldo14_voltage,
 351         .get_voltage    = da9030_get_ldo14_voltage,
 352         .list_voltage   = da903x_list_voltage,
 353         .enable         = da903x_enable,
 354         .disable        = da903x_disable,
 355         .is_enabled     = da903x_is_enabled,
 356 };
 357
 358 /* NOTE: this is dedicated for the DA9030 LDO1 and LDO15 that have locks  */
 359 static struct regulator_ops da9030_regulator_ldo1_15_ops = {
 360         .set_voltage    = da9030_set_ldo1_15_voltage,
 361         .get_voltage    = da903x_get_voltage,
 362         .list_voltage   = da903x_list_voltage,
 363         .enable         = da903x_enable,
 364         .disable        = da903x_disable,
 365         .is_enabled     = da903x_is_enabled,
 366 };
 367
 368 static struct regulator_ops da9034_regulator_dvc_ops = {
 369         .set_voltage    = da9034_set_dvc_voltage,
 370         .get_voltage    = da903x_get_voltage,
 371         .list_voltage   = da903x_list_voltage,
 372         .enable         = da903x_enable,
 373         .disable        = da903x_disable,
 374         .is_enabled     = da903x_is_enabled,
 375 };
 376
 377 /* NOTE: this is dedicated for the insane LDO12 */
 378 static struct regulator_ops da9034_regulator_ldo12_ops = {
 379         .set_voltage    = da9034_set_ldo12_voltage,
 380         .get_voltage    = da9034_get_ldo12_voltage,
 381         .list_voltage   = da9034_list_ldo12_voltage,
 382         .enable         = da903x_enable,
 383         .disable        = da903x_disable,
 384         .is_enabled     = da903x_is_enabled,
 385 };
 386
 387 #define DA903x_LDO(_pmic, _id, min, max, step, vreg, shift, nbits, ereg, ebit)  \
 388 {                                                                       \
 389         .desc   = {                                                     \
 390                 .name   = "LDO" #_id,                                   \
 391                 .ops    = &da903x_regulator_ldo_ops,                    \
 392                 .type   = REGULATOR_VOLTAGE,                            \
 393                 .id     = _pmic##_ID_LDO##_id,                          \
 394                 .n_voltages = (step) ? ((max - min) / step + 1) : 1,    \
 395                 .owner  = THIS_MODULE,                                  \
 396         },                                                              \
 397         .min_uV         = (min) * 1000,                                 \
 398         .max_uV         = (max) * 1000,                                 \
 399         .step_uV        = (step) * 1000,                                \
 400         .vol_reg        = _pmic##_##vreg,                               \
 401         .vol_shift      = (shift),                                      \
 402         .vol_nbits      = (nbits),                                      \
 403         .enable_reg     = _pmic##_##ereg,                               \
 404         .enable_bit     = (ebit),                                       \
 405 }
 406
 407 #define DA903x_DVC(_pmic, _id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
 408 {                                                                       \
 409         .desc   = {                                                     \
 410                 .name   = #_id,                                         \
 411                 .ops    = &da9034_regulator_dvc_ops,                    \
 412                 .type   = REGULATOR_VOLTAGE,                            \
 413                 .id     = _pmic##_ID_##_id,                             \
 414                 .n_voltages = (step) ? ((max - min) / step + 1) : 1,    \
 415                 .owner  = THIS_MODULE,                                  \
 416         },                                                              \
 417         .min_uV         = (min) * 1000,                                 \
 418         .max_uV         = (max) * 1000,                                 \
 419         .step_uV        = (step) * 1000,                                \
 420         .vol_reg        = _pmic##_##vreg,                               \
 421         .vol_shift      = (0),                                          \
 422         .vol_nbits      = (nbits),                                      \
 423         .update_reg     = _pmic##_##ureg,                               \
 424         .update_bit     = (ubit),                                       \
 425         .enable_reg     = _pmic##_##ereg,                               \
 426         .enable_bit     = (ebit),                                       \
 427 }
 428
 429 #define DA9034_LDO(_id, min, max, step, vreg, shift, nbits, ereg, ebit) \
 430         DA903x_LDO(DA9034, _id, min, max, step, vreg, shift, nbits, ereg, ebit)
 431
 432 #define DA9030_LDO(_id, min, max, step, vreg, shift, nbits, ereg, ebit) \
 433         DA903x_LDO(DA9030, _id, min, max, step, vreg, shift, nbits, ereg, ebit)
 434
 435 #define DA9030_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
 436         DA903x_DVC(DA9030, _id, min, max, step, vreg, nbits, ureg, ubit, \
 437                    ereg, ebit)
 438
 439 #define DA9034_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
 440         DA903x_DVC(DA9034, _id, min, max, step, vreg, nbits, ureg, ubit, \
 441                    ereg, ebit)
 442
 443 #define DA9035_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
 444         DA903x_DVC(DA9035, _id, min, max, step, vreg, nbits, ureg, ubit, \
 445                    ereg, ebit)
 446
 447 static struct da903x_regulator_info da903x_regulator_info[] = {
 448         /* DA9030 */
 449         DA9030_DVC(BUCK2, 850, 1625, 25, BUCK2DVM1, 5, BUCK2DVM1, 7, RCTL11, 0),
 450
 451         DA9030_LDO( 1, 1200, 3200, 100,    LDO1, 0, 5, RCTL12, 1),
 452         DA9030_LDO( 2, 1800, 3200, 100,   LDO23, 0, 4, RCTL12, 2),
 453         DA9030_LDO( 3, 1800, 3200, 100,   LDO23, 4, 4, RCTL12, 3),
 454         DA9030_LDO( 4, 1800, 3200, 100,   LDO45, 0, 4, RCTL12, 4),
 455         DA9030_LDO( 5, 1800, 3200, 100,   LDO45, 4, 4, RCTL12, 5),
 456         DA9030_LDO( 6, 1800, 3200, 100,    LDO6, 0, 4, RCTL12, 6),
 457         DA9030_LDO( 7, 1800, 3200, 100,   LDO78, 0, 4, RCTL12, 7),
 458         DA9030_LDO( 8, 1800, 3200, 100,   LDO78, 4, 4, RCTL22, 0),
 459         DA9030_LDO( 9, 1800, 3200, 100,  LDO912, 0, 4, RCTL22, 1),
 460         DA9030_LDO(10, 1800, 3200, 100, LDO1011, 0, 4, RCTL22, 2),
 461         DA9030_LDO(11, 1800, 3200, 100, LDO1011, 4, 4, RCTL22, 3),
 462         DA9030_LDO(12, 1800, 3200, 100,  LDO912, 4, 4, RCTL22, 4),
 463         DA9030_LDO(14, 2760, 2940,  30, LDO1416, 0, 3, RCTL11, 4),
 464         DA9030_LDO(15, 1100, 2650,  50,   LDO15, 0, 5, RCTL11, 5),
 465         DA9030_LDO(16, 1100, 2650,  50, LDO1416, 3, 5, RCTL11, 6),
 466         DA9030_LDO(17, 1800, 3200, 100,   LDO17, 0, 4, RCTL11, 7),
 467         DA9030_LDO(18, 1800, 3200, 100, LDO1819, 0, 4, RCTL21, 2),
 468         DA9030_LDO(19, 1800, 3200, 100, LDO1819, 4, 4, RCTL21, 1),
 469         DA9030_LDO(13, 2100, 2100, 0, INVAL, 0, 0, RCTL11, 3), /* fixed @2.1V */
 470
 471         /* DA9034 */
 472         DA9034_DVC(BUCK1, 725, 1500, 25, ADTV2, 5, VCC1, 0, OVER1, 0),
 473         DA9034_DVC(BUCK2, 725, 1500, 25, CDTV2, 5, VCC1, 2, OVER1, 1),
 474         DA9034_DVC(LDO2,  725, 1500, 25, SDTV2, 5, VCC1, 4, OVER1, 2),
 475         DA9034_DVC(LDO1, 1700, 2075, 25, MDTV1, 4, VCC1, 6, OVER3, 4),
 476
 477         DA9034_LDO( 3, 1800, 3300, 100,  LDO643, 0, 4, OVER3, 5),
 478         DA9034_LDO( 4, 1800, 2900,1100,  LDO643, 4, 1, OVER3, 6),
 479         DA9034_LDO( 6, 2500, 2850,  50,  LDO643, 5, 3, OVER2, 0),
 480         DA9034_LDO( 7, 2700, 3050,  50,  LDO987, 0, 3, OVER2, 1),
 481         DA9034_LDO( 8, 2700, 2850,  50,  LDO987, 3, 2, OVER2, 2),
 482         DA9034_LDO( 9, 2700, 3050,  50,  LDO987, 5, 3, OVER2, 3),
 483         DA9034_LDO(10, 2700, 3050,  50, LDO1110, 0, 3, OVER2, 4),
 484         DA9034_LDO(11, 1800, 3300, 100, LDO1110, 4, 4, OVER2, 5),
 485         DA9034_LDO(12, 1700, 3050,  50, LDO1312, 0, 4, OVER3, 6),
 486         DA9034_LDO(13, 1800, 3300, 100, LDO1312, 4, 4, OVER2, 7),
 487         DA9034_LDO(14, 1800, 3300, 100, LDO1514, 0, 4, OVER3, 0),
 488         DA9034_LDO(15, 1800, 3300, 100, LDO1514, 4, 4, OVER3, 1),
 489         DA9034_LDO(5, 3100, 3100, 0, INVAL, 0, 0, OVER3, 7), /* fixed @3.1V */
 490
 491         /* DA9035 */
 492         DA9035_DVC(BUCK3, 1800, 2200, 100, 3DTV1, 3, VCC2, 0, OVER3, 3),
 493 };
 494
 495 static inline struct da903x_regulator_info *find_regulator_info(int id)
 496 {
 497         struct da903x_regulator_info *ri;
 498         int i;
 499
 500         for (i = 0; i < ARRAY_SIZE(da903x_regulator_info); i++) {
 501                 ri = &da903x_regulator_info[i];
 502                 if (ri->desc.id == id)
 503                         return ri;
 504         }
 505         return NULL;
 506 }
 507
 508 static int __devinit da903x_regulator_probe(struct platform_device *pdev)
 509 {
 510         struct da903x_regulator_info *ri = NULL;
 511         struct regulator_dev *rdev;
 512
 513         ri = find_regulator_info(pdev->id);
 514         if (ri == NULL) {
 515                 dev_err(&pdev->dev, "invalid regulator ID specified\n");
 516                 return -EINVAL;
 517         }
 518
 519         /* Workaround for the weird LDO12 voltage setting */
 520         if (ri->desc.id == DA9034_ID_LDO12) {
 521                 ri->desc.ops = &da9034_regulator_ldo12_ops;
 522                 ri->desc.n_voltages = ARRAY_SIZE(da9034_ldo12_data);
 523         }
 524
 525         if (ri->desc.id == DA9030_ID_LDO14)
 526                 ri->desc.ops = &da9030_regulator_ldo14_ops;
 527
 528         if (ri->desc.id == DA9030_ID_LDO1 || ri->desc.id == DA9030_ID_LDO15)
 529                 ri->desc.ops = &da9030_regulator_ldo1_15_ops;
 530
 531         rdev = regulator_register(&ri->desc, &pdev->dev,
 532                                   pdev->dev.platform_data, ri);
 533         if (IS_ERR(rdev)) {
 534                 dev_err(&pdev->dev, "failed to register regulator %s\n",
 535                                 ri->desc.name);
 536                 return PTR_ERR(rdev);
 537         }
 538
 539         platform_set_drvdata(pdev, rdev);
 540         return 0;
 541 }
 542
 543 static int __devexit da903x_regulator_remove(struct platform_device *pdev)
 544 {
 545         struct regulator_dev *rdev = platform_get_drvdata(pdev);
 546
 547         regulator_unregister(rdev);
 548         return 0;
 549 }
 550
 551 static struct platform_driver da903x_regulator_driver = {
 552         .driver = {
 553                 .name   = "da903x-regulator",
 554                 .owner  = THIS_MODULE,
 555         },
 556         .probe          = da903x_regulator_probe,
 557         .remove         = __devexit_p(da903x_regulator_remove),
 558 };
 559
 560 static int __init da903x_regulator_init(void)
 561 {
 562         return platform_driver_register(&da903x_regulator_driver);
 563 }
 564 subsys_initcall(da903x_regulator_init);
 565
 566 static void __exit da903x_regulator_exit(void)
 567 {
 568         platform_driver_unregister(&da903x_regulator_driver);
 569 }
 570 module_exit(da903x_regulator_exit);
 571
 572 MODULE_LICENSE("GPL");
 573 MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>"
 574               "Mike Rapoport <mike@compulab.co.il>");
 575 MODULE_DESCRIPTION("Regulator Driver for Dialog Semiconductor DA903X PMIC");
 576 MODULE_ALIAS("platform:da903x-regulator");