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