SAFE public projects git trees. - safe/jmp/linux-2.6/blob - 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 inline struct device *to_da903x_dev(struct regulator_dev *rdev)
  91 {
  92         return rdev_get_dev(rdev)->parent->parent;
  93 }
  94
  95 static inline int check_range(struct da903x_regulator_info *info,
  96                                 int min_uV, int max_uV)
  97 {
  98         if (min_uV < info->min_uV || min_uV > info->max_uV)
  99                 return -EINVAL;
 100
 101         return 0;
 102 }
 103
 104 /* DA9030/DA9034 common operations */
 105 static int da903x_set_ldo_voltage(struct regulator_dev *rdev,
 106                                   int min_uV, int max_uV)
 107 {
 108         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 109         struct device *da9034_dev = to_da903x_dev(rdev);
 110         uint8_t val, mask;
 111
 112         if (check_range(info, min_uV, max_uV)) {
 113                 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
 114                 return -EINVAL;
 115         }
 116
 117         val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
 118         val <<= info->vol_shift;
 119         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 120
 121         return da903x_update(da9034_dev, info->vol_reg, val, mask);
 122 }
 123
 124 static int da903x_get_voltage(struct regulator_dev *rdev)
 125 {
 126         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 127         struct device *da9034_dev = to_da903x_dev(rdev);
 128         uint8_t val, mask;
 129         int ret;
 130
 131         ret = da903x_read(da9034_dev, info->vol_reg, &val);
 132         if (ret)
 133                 return ret;
 134
 135         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 136         val = (val & mask) >> info->vol_shift;
 137
 138         return info->min_uV + info->step_uV * val;
 139 }
 140
 141 static int da903x_enable(struct regulator_dev *rdev)
 142 {
 143         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 144         struct device *da9034_dev = to_da903x_dev(rdev);
 145
 146         return da903x_set_bits(da9034_dev, info->enable_reg,
 147                                         1 << info->enable_bit);
 148 }
 149
 150 static int da903x_disable(struct regulator_dev *rdev)
 151 {
 152         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 153         struct device *da9034_dev = to_da903x_dev(rdev);
 154
 155         return da903x_clr_bits(da9034_dev, info->enable_reg,
 156                                         1 << info->enable_bit);
 157 }
 158
 159 static int da903x_is_enabled(struct regulator_dev *rdev)
 160 {
 161         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 162         struct device *da9034_dev = to_da903x_dev(rdev);
 163         uint8_t reg_val;
 164         int ret;
 165
 166         ret = da903x_read(da9034_dev, info->enable_reg, &reg_val);
 167         if (ret)
 168                 return ret;
 169
 170         return !!(reg_val & (1 << info->enable_bit));
 171 }
 172
 173 /* DA9030 specific operations */
 174 static int da9030_set_ldo1_15_voltage(struct regulator_dev *rdev,
 175                                        int min_uV, int max_uV)
 176 {
 177         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 178         struct device *da903x_dev = to_da903x_dev(rdev);
 179         uint8_t val, mask;
 180         int ret;
 181
 182         if (check_range(info, min_uV, max_uV)) {
 183                 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
 184                 return -EINVAL;
 185         }
 186
 187         val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
 188         val <<= info->vol_shift;
 189         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 190         val |= DA9030_LDO_UNLOCK; /* have to set UNLOCK bits */
 191         mask |= DA9030_LDO_UNLOCK_MASK;
 192
 193         /* write twice */
 194         ret = da903x_update(da903x_dev, info->vol_reg, val, mask);
 195         if (ret)
 196                 return ret;
 197
 198         return da903x_update(da903x_dev, info->vol_reg, val, mask);
 199 }
 200
 201 static int da9030_set_ldo14_voltage(struct regulator_dev *rdev,
 202                                   int min_uV, int max_uV)
 203 {
 204         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 205         struct device *da903x_dev = to_da903x_dev(rdev);
 206         uint8_t val, mask;
 207         int thresh;
 208
 209         if (check_range(info, min_uV, max_uV)) {
 210                 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
 211                 return -EINVAL;
 212         }
 213
 214         thresh = (info->max_uV + info->min_uV) / 2;
 215         if (min_uV < thresh) {
 216                 val = (thresh - min_uV + info->step_uV - 1) / info->step_uV;
 217                 val |= 0x4;
 218         } else {
 219                 val = (min_uV - thresh + info->step_uV - 1) / info->step_uV;
 220         }
 221
 222         val <<= info->vol_shift;
 223         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 224
 225         return da903x_update(da903x_dev, info->vol_reg, val, mask);
 226 }
 227
 228 static int da9030_get_ldo14_voltage(struct regulator_dev *rdev)
 229 {
 230         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 231         struct device *da903x_dev = to_da903x_dev(rdev);
 232         uint8_t val, mask;
 233         int ret;
 234
 235         ret = da903x_read(da903x_dev, info->vol_reg, &val);
 236         if (ret)
 237                 return ret;
 238
 239         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 240         val = (val & mask) >> info->vol_shift;
 241
 242         if (val & 0x4)
 243                 return info->min_uV + info->step_uV * (3 - (val & ~0x4));
 244         else
 245                 return (info->max_uV + info->min_uV) / 2 +
 246                         info->step_uV * (val & ~0x4);
 247 }
 248
 249 /* DA9034 specific operations */
 250 static int da9034_set_dvc_voltage(struct regulator_dev *rdev,
 251                                   int min_uV, int max_uV)
 252 {
 253         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 254         struct device *da9034_dev = to_da903x_dev(rdev);
 255         uint8_t val, mask;
 256         int ret;
 257
 258         if (check_range(info, min_uV, max_uV)) {
 259                 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
 260                 return -EINVAL;
 261         }
 262
 263         val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
 264         val <<= info->vol_shift;
 265         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 266
 267         ret = da903x_update(da9034_dev, info->vol_reg, val, mask);
 268         if (ret)
 269                 return ret;
 270
 271         ret = da903x_set_bits(da9034_dev, info->update_reg,
 272                                         1 << info->update_bit);
 273         return ret;
 274 }
 275
 276 static int da9034_set_ldo12_voltage(struct regulator_dev *rdev,
 277                                     int min_uV, int max_uV)
 278 {
 279         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 280         struct device *da9034_dev = to_da903x_dev(rdev);
 281         uint8_t val, mask;
 282
 283         if (check_range(info, min_uV, max_uV)) {
 284                 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
 285                 return -EINVAL;
 286         }
 287
 288         val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
 289         val = (val > 7 || val < 20) ? 8 : val - 12;
 290         val <<= info->vol_shift;
 291         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 292
 293         return da903x_update(da9034_dev, info->vol_reg, val, mask);
 294 }
 295
 296 static int da9034_get_ldo12_voltage(struct regulator_dev *rdev)
 297 {
 298         struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
 299         struct device *da9034_dev = to_da903x_dev(rdev);
 300         uint8_t val, mask;
 301         int ret;
 302
 303         ret = da903x_read(da9034_dev, info->vol_reg, &val);
 304         if (ret)
 305                 return ret;
 306
 307         mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
 308         val = (val & mask) >> info->vol_shift;
 309
 310         if (val >= 8)
 311                 return 2700000 + info->step_uV * (val - 8);
 312
 313         return info->min_uV + info->step_uV * val;
 314 }
 315
 316 static struct regulator_ops da903x_regulator_ldo_ops = {
 317         .set_voltage    = da903x_set_ldo_voltage,
 318         .get_voltage    = da903x_get_voltage,
 319         .enable         = da903x_enable,
 320         .disable        = da903x_disable,
 321         .is_enabled     = da903x_is_enabled,
 322 };
 323
 324 /* NOTE: this is dedicated for the insane DA9030 LDO14 */
 325 static struct regulator_ops da9030_regulator_ldo14_ops = {
 326         .set_voltage    = da9030_set_ldo14_voltage,
 327         .get_voltage    = da9030_get_ldo14_voltage,
 328         .enable         = da903x_enable,
 329         .disable        = da903x_disable,
 330         .is_enabled     = da903x_is_enabled,
 331 };
 332
 333 /* NOTE: this is dedicated for the DA9030 LDO1 and LDO15 that have locks  */
 334 static struct regulator_ops da9030_regulator_ldo1_15_ops = {
 335         .set_voltage    = da9030_set_ldo1_15_voltage,
 336         .get_voltage    = da903x_get_voltage,
 337         .enable         = da903x_enable,
 338         .disable        = da903x_disable,
 339         .is_enabled     = da903x_is_enabled,
 340 };
 341
 342 static struct regulator_ops da9034_regulator_dvc_ops = {
 343         .set_voltage    = da9034_set_dvc_voltage,
 344         .get_voltage    = da903x_get_voltage,
 345         .enable         = da903x_enable,
 346         .disable        = da903x_disable,
 347         .is_enabled     = da903x_is_enabled,
 348 };
 349
 350 /* NOTE: this is dedicated for the insane LDO12 */
 351 static struct regulator_ops da9034_regulator_ldo12_ops = {
 352         .set_voltage    = da9034_set_ldo12_voltage,
 353         .get_voltage    = da9034_get_ldo12_voltage,
 354         .enable         = da903x_enable,
 355         .disable        = da903x_disable,
 356         .is_enabled     = da903x_is_enabled,
 357 };
 358
 359 #define DA903x_LDO(_pmic, _id, min, max, step, vreg, shift, nbits, ereg, ebit)  \
 360 {                                                                       \
 361         .desc   = {                                                     \
 362                 .name   = "LDO" #_id,                                   \
 363                 .ops    = &da903x_regulator_ldo_ops,                    \
 364                 .type   = REGULATOR_VOLTAGE,                            \
 365                 .id     = _pmic##_ID_LDO##_id,                          \
 366                 .owner  = THIS_MODULE,                                  \
 367         },                                                              \
 368         .min_uV         = (min) * 1000,                                 \
 369         .max_uV         = (max) * 1000,                                 \
 370         .step_uV        = (step) * 1000,                                \
 371         .vol_reg        = _pmic##_##vreg,                               \
 372         .vol_shift      = (shift),                                      \
 373         .vol_nbits      = (nbits),                                      \
 374         .enable_reg     = _pmic##_##ereg,                               \
 375         .enable_bit     = (ebit),                                       \
 376 }
 377
 378 #define DA9030_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
 379 {                                                                       \
 380         .desc   = {                                                     \
 381                 .name   = #_id,                                         \
 382                 .ops    = &da9034_regulator_dvc_ops,                    \
 383                 .type   = REGULATOR_VOLTAGE,                            \
 384                 .id     = DA9030_ID_##_id,                              \
 385                 .owner  = THIS_MODULE,                                  \
 386         },                                                              \
 387         .min_uV         = (min) * 1000,                                 \
 388         .max_uV         = (max) * 1000,                                 \
 389         .step_uV        = (step) * 1000,                                \
 390         .vol_reg        = DA9030_##vreg,                                \
 391         .vol_shift      = (0),                                          \
 392         .vol_nbits      = (nbits),                                      \
 393         .update_reg     = DA9030_##ureg,                                \
 394         .update_bit     = (ubit),                                       \
 395         .enable_reg     = DA9030_##ereg,                                \
 396         .enable_bit     = (ebit),                                       \
 397 }
 398
 399 #define DA9034_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
 400 {                                                                       \
 401         .desc   = {                                                     \
 402                 .name   = #_id,                                         \
 403                 .ops    = &da9034_regulator_dvc_ops,                    \
 404                 .type   = REGULATOR_VOLTAGE,                            \
 405                 .id     = DA9034_ID_##_id,                              \
 406                 .owner  = THIS_MODULE,                                  \
 407         },                                                              \
 408         .min_uV         = (min) * 1000,                                 \
 409         .max_uV         = (max) * 1000,                                 \
 410         .step_uV        = (step) * 1000,                                \
 411         .vol_reg        = DA9034_##vreg,                                \
 412         .vol_shift      = (0),                                          \
 413         .vol_nbits      = (nbits),                                      \
 414         .update_reg     = DA9034_##ureg,                                \
 415         .update_bit     = (ubit),                                       \
 416         .enable_reg     = DA9034_##ereg,                                \
 417         .enable_bit     = (ebit),                                       \
 418 }
 419
 420 #define DA9035_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
 421 {                                                                       \
 422         .desc   = {                                                     \
 423                 .name   = #_id,                                         \
 424                 .ops    = &da9034_regulator_dvc_ops,                    \
 425                 .type   = REGULATOR_VOLTAGE,                            \
 426                 .id     = DA9035_ID_##_id,                              \
 427                 .owner  = THIS_MODULE,                                  \
 428         },                                                              \
 429         .min_uV         = (min) * 1000,                                 \
 430         .max_uV         = (max) * 1000,                                 \
 431         .step_uV        = (step) * 1000,                                \
 432         .vol_reg        = DA9035_##vreg,                                \
 433         .vol_shift      = (0),                                          \
 434         .vol_nbits      = (nbits),                                      \
 435         .update_reg     = DA9035_##ureg,                                \
 436         .update_bit     = (ubit),                                       \
 437         .enable_reg     = DA9035_##ereg,                                \
 438         .enable_bit     = (ebit),                                       \
 439 }
 440
 441 #define DA9034_LDO(_id, min, max, step, vreg, shift, nbits, ereg, ebit) \
 442         DA903x_LDO(DA9034, _id, min, max, step, vreg, shift, nbits, ereg, ebit)
 443
 444 #define DA9030_LDO(_id, min, max, step, vreg, shift, nbits, ereg, ebit) \
 445         DA903x_LDO(DA9030, _id, min, max, step, vreg, shift, nbits, 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, ADTV1, 5, VCC1, 0, OVER1, 0),
 473         DA9034_DVC(BUCK2, 725, 1500, 25, CDTV1, 5, VCC1, 2, OVER1, 1),
 474         DA9034_DVC(LDO2,  725, 1500, 25, SDTV1, 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
 523         if (ri->desc.id == DA9030_ID_LDO14)
 524                 ri->desc.ops = &da9030_regulator_ldo14_ops;
 525
 526         if (ri->desc.id == DA9030_ID_LDO1 || ri->desc.id == DA9030_ID_LDO15)
 527                 ri->desc.ops = &da9030_regulator_ldo1_15_ops;
 528
 529         rdev = regulator_register(&ri->desc, &pdev->dev,
 530                                   pdev->dev.platform_data, ri);
 531         if (IS_ERR(rdev)) {
 532                 dev_err(&pdev->dev, "failed to register regulator %s\n",
 533                                 ri->desc.name);
 534                 return PTR_ERR(rdev);
 535         }
 536
 537         platform_set_drvdata(pdev, rdev);
 538         return 0;
 539 }
 540
 541 static int __devexit da903x_regulator_remove(struct platform_device *pdev)
 542 {
 543         struct regulator_dev *rdev = platform_get_drvdata(pdev);
 544
 545         regulator_unregister(rdev);
 546         return 0;
 547 }
 548
 549 static struct platform_driver da903x_regulator_driver = {
 550         .driver = {
 551                 .name   = "da903x-regulator",
 552                 .owner  = THIS_MODULE,
 553         },
 554         .probe          = da903x_regulator_probe,
 555         .remove         = __devexit_p(da903x_regulator_remove),
 556 };
 557
 558 static int __init da903x_regulator_init(void)
 559 {
 560         return platform_driver_register(&da903x_regulator_driver);
 561 }
 562 subsys_initcall(da903x_regulator_init);
 563
 564 static void __exit da903x_regulator_exit(void)
 565 {
 566         platform_driver_unregister(&da903x_regulator_driver);
 567 }
 568 module_exit(da903x_regulator_exit);
 569
 570 MODULE_LICENSE("GPL");
 571 MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>"
 572               "Mike Rapoport <mike@compulab.co.il>");
 573 MODULE_DESCRIPTION("Regulator Driver for Dialog Semiconductor DA903X PMIC");
 574 MODULE_ALIAS("platform:da903x-regulator");