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