drivers/regulator/max8998.c

   1 /*
   2  * max8998.c - Voltage regulator driver for the Maxim 8998
   3  *
   4  *  Copyright (C) 2009-2010 Samsung Electronics
   5  *  Kyungmin Park <[email protected]>
   6  *  Marek Szyprowski <[email protected]>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  21  */
  22
  23 #include <linux/module.h>
  24 #include <linux/init.h>
  25 #include <linux/i2c.h>
  26 #include <linux/err.h>
  27 #include <linux/gpio.h>
  28 #include <linux/slab.h>
  29 #include <linux/interrupt.h>
  30 #include <linux/mutex.h>
  31 #include <linux/platform_device.h>
  32 #include <linux/regulator/driver.h>
  33 #include <linux/mfd/max8998.h>
  34 #include <linux/mfd/max8998-private.h>
  35
  36 struct max8998_data {
  37         struct device           *dev;
  38         struct max8998_dev      *iodev;
  39         int                     num_regulators;
  40         struct regulator_dev    **rdev;
  41         u8                      buck1_vol[4]; /* voltages for selection */
  42         u8                      buck2_vol[2];
  43         unsigned int            buck1_idx; /* index to last changed voltage */
  44                                            /* value in a set */
  45         unsigned int            buck2_idx;
  46 };
  47
  48 struct voltage_map_desc {
  49         int min;
  50         int max;
  51         int step;
  52 };
  53
  54 /* Voltage maps in uV*/
  55 static const struct voltage_map_desc ldo23_voltage_map_desc = {
  56         .min = 800000,  .step = 50000,  .max = 1300000,
  57 };
  58 static const struct voltage_map_desc ldo456711_voltage_map_desc = {
  59         .min = 1600000, .step = 100000, .max = 3600000,
  60 };
  61 static const struct voltage_map_desc ldo8_voltage_map_desc = {
  62         .min = 3000000, .step = 100000, .max = 3600000,
  63 };
  64 static const struct voltage_map_desc ldo9_voltage_map_desc = {
  65         .min = 2800000, .step = 100000, .max = 3100000,
  66 };
  67 static const struct voltage_map_desc ldo10_voltage_map_desc = {
  68         .min = 950000,  .step = 50000,  .max = 1300000,
  69 };
  70 static const struct voltage_map_desc ldo1213_voltage_map_desc = {
  71         .min = 800000,  .step = 100000, .max = 3300000,
  72 };
  73 static const struct voltage_map_desc ldo1415_voltage_map_desc = {
  74         .min = 1200000, .step = 100000, .max = 3300000,
  75 };
  76 static const struct voltage_map_desc ldo1617_voltage_map_desc = {
  77         .min = 1600000, .step = 100000, .max = 3600000,
  78 };
  79 static const struct voltage_map_desc buck12_voltage_map_desc = {
  80         .min = 750000,  .step = 25000,  .max = 1525000,
  81 };
  82 static const struct voltage_map_desc buck3_voltage_map_desc = {
  83         .min = 1600000, .step = 100000, .max = 3600000,
  84 };
  85 static const struct voltage_map_desc buck4_voltage_map_desc = {
  86         .min = 800000,  .step = 100000, .max = 2300000,
  87 };
  88
  89 static const struct voltage_map_desc *ldo_voltage_map[] = {
  90         NULL,
  91         NULL,
  92         &ldo23_voltage_map_desc,        /* LDO2 */
  93         &ldo23_voltage_map_desc,        /* LDO3 */
  94         &ldo456711_voltage_map_desc,    /* LDO4 */
  95         &ldo456711_voltage_map_desc,    /* LDO5 */
  96         &ldo456711_voltage_map_desc,    /* LDO6 */
  97         &ldo456711_voltage_map_desc,    /* LDO7 */
  98         &ldo8_voltage_map_desc,         /* LDO8 */
  99         &ldo9_voltage_map_desc,         /* LDO9 */
 100         &ldo10_voltage_map_desc,        /* LDO10 */
 101         &ldo456711_voltage_map_desc,    /* LDO11 */
 102         &ldo1213_voltage_map_desc,      /* LDO12 */
 103         &ldo1213_voltage_map_desc,      /* LDO13 */
 104         &ldo1415_voltage_map_desc,      /* LDO14 */
 105         &ldo1415_voltage_map_desc,      /* LDO15 */
 106         &ldo1617_voltage_map_desc,      /* LDO16 */
 107         &ldo1617_voltage_map_desc,      /* LDO17 */
 108         &buck12_voltage_map_desc,       /* BUCK1 */
 109         &buck12_voltage_map_desc,       /* BUCK2 */
 110         &buck3_voltage_map_desc,        /* BUCK3 */
 111         &buck4_voltage_map_desc,        /* BUCK4 */
 112 };
 113
 114 static int max8998_get_enable_register(struct regulator_dev *rdev,
 115                                         int *reg, int *shift)
 116 {
 117         int ldo = rdev_get_id(rdev);
 118
 119         switch (ldo) {
 120         case MAX8998_LDO2 ... MAX8998_LDO5:
 121                 *reg = MAX8998_REG_ONOFF1;
 122                 *shift = 3 - (ldo - MAX8998_LDO2);
 123                 break;
 124         case MAX8998_LDO6 ... MAX8998_LDO13:
 125                 *reg = MAX8998_REG_ONOFF2;
 126                 *shift = 7 - (ldo - MAX8998_LDO6);
 127                 break;
 128         case MAX8998_LDO14 ... MAX8998_LDO17:
 129                 *reg = MAX8998_REG_ONOFF3;
 130                 *shift = 7 - (ldo - MAX8998_LDO14);
 131                 break;
 132         case MAX8998_BUCK1 ... MAX8998_BUCK4:
 133                 *reg = MAX8998_REG_ONOFF1;
 134                 *shift = 7 - (ldo - MAX8998_BUCK1);
 135                 break;
 136         case MAX8998_EN32KHZ_AP ... MAX8998_ENVICHG:
 137                 *reg = MAX8998_REG_ONOFF4;
 138                 *shift = 7 - (ldo - MAX8998_EN32KHZ_AP);
 139                 break;
 140         case MAX8998_ESAFEOUT1 ... MAX8998_ESAFEOUT2:
 141                 *reg = MAX8998_REG_CHGR2;
 142                 *shift = 7 - (ldo - MAX8998_ESAFEOUT1);
 143                 break;
 144         default:
 145                 return -EINVAL;
 146         }
 147
 148         return 0;
 149 }
 150
 151 static int max8998_ldo_is_enabled(struct regulator_dev *rdev)
 152 {
 153         struct max8998_data *max8998 = rdev_get_drvdata(rdev);
 154         struct i2c_client *i2c = max8998->iodev->i2c;
 155         int ret, reg, shift = 8;
 156         u8 val;
 157
 158         ret = max8998_get_enable_register(rdev, &reg, &shift);
 159         if (ret)
 160                 return ret;
 161
 162         ret = max8998_read_reg(i2c, reg, &val);
 163         if (ret)
 164                 return ret;
 165
 166         return val & (1 << shift);
 167 }
 168
 169 static int max8998_ldo_enable(struct regulator_dev *rdev)
 170 {
 171         struct max8998_data *max8998 = rdev_get_drvdata(rdev);
 172         struct i2c_client *i2c = max8998->iodev->i2c;
 173         int reg, shift = 8, ret;
 174
 175         ret = max8998_get_enable_register(rdev, &reg, &shift);
 176         if (ret)
 177                 return ret;
 178
 179         return max8998_update_reg(i2c, reg, 1<<shift, 1<<shift);
 180 }
 181
 182 static int max8998_ldo_disable(struct regulator_dev *rdev)
 183 {
 184         struct max8998_data *max8998 = rdev_get_drvdata(rdev);
 185         struct i2c_client *i2c = max8998->iodev->i2c;
 186         int reg, shift = 8, ret;
 187
 188         ret = max8998_get_enable_register(rdev, &reg, &shift);
 189         if (ret)
 190                 return ret;
 191
 192         return max8998_update_reg(i2c, reg, 0, 1<<shift);
 193 }
 194
 195 static int max8998_get_voltage_register(struct regulator_dev *rdev,
 196                                 int *_reg, int *_shift, int *_mask)
 197 {
 198         int ldo = rdev_get_id(rdev);
 199         struct max8998_data *max8998 = rdev_get_drvdata(rdev);
 200         int reg, shift = 0, mask = 0xff;
 201
 202         switch (ldo) {
 203         case MAX8998_LDO2 ... MAX8998_LDO3:
 204                 reg = MAX8998_REG_LDO2_LDO3;
 205                 mask = 0xf;
 206                 if (ldo == MAX8998_LDO2)
 207                         shift = 4;
 208                 else
 209                         shift = 0;
 210                 break;
 211         case MAX8998_LDO4 ... MAX8998_LDO7:
 212                 reg = MAX8998_REG_LDO4 + (ldo - MAX8998_LDO4);
 213                 break;
 214         case MAX8998_LDO8 ... MAX8998_LDO9:
 215                 reg = MAX8998_REG_LDO8_LDO9;
 216                 mask = 0xf;
 217                 if (ldo == MAX8998_LDO8)
 218                         shift = 4;
 219                 else
 220                         shift = 0;
 221                 break;
 222         case MAX8998_LDO10 ... MAX8998_LDO11:
 223                 reg = MAX8998_REG_LDO10_LDO11;
 224                 if (ldo == MAX8998_LDO10) {
 225                         shift = 5;
 226                         mask = 0x7;
 227                 } else {
 228                         shift = 0;
 229                         mask = 0x1f;
 230                 }
 231                 break;
 232         case MAX8998_LDO12 ... MAX8998_LDO17:
 233                 reg = MAX8998_REG_LDO12 + (ldo - MAX8998_LDO12);
 234                 break;
 235         case MAX8998_BUCK1:
 236                 reg = MAX8998_REG_BUCK1_VOLTAGE1 + max8998->buck1_idx;
 237                 break;
 238         case MAX8998_BUCK2:
 239                 reg = MAX8998_REG_BUCK2_VOLTAGE1 + max8998->buck2_idx;
 240                 break;
 241         case MAX8998_BUCK3:
 242                 reg = MAX8998_REG_BUCK3;
 243                 break;
 244         case MAX8998_BUCK4:
 245                 reg = MAX8998_REG_BUCK4;
 246                 break;
 247         default:
 248                 return -EINVAL;
 249         }
 250
 251         *_reg = reg;
 252         *_shift = shift;
 253         *_mask = mask;
 254
 255         return 0;
 256 }
 257
 258 static int max8998_get_voltage_sel(struct regulator_dev *rdev)
 259 {
 260         struct max8998_data *max8998 = rdev_get_drvdata(rdev);
 261         struct i2c_client *i2c = max8998->iodev->i2c;
 262         int reg, shift = 0, mask, ret;
 263         u8 val;
 264
 265         ret = max8998_get_voltage_register(rdev, &reg, &shift, &mask);
 266         if (ret)
 267                 return ret;
 268
 269         ret = max8998_read_reg(i2c, reg, &val);
 270         if (ret)
 271                 return ret;
 272
 273         val >>= shift;
 274         val &= mask;
 275
 276         return val;
 277 }
 278
 279 static int max8998_set_voltage_ldo_sel(struct regulator_dev *rdev,
 280                                        unsigned selector)
 281 {
 282         struct max8998_data *max8998 = rdev_get_drvdata(rdev);
 283         struct i2c_client *i2c = max8998->iodev->i2c;
 284         int reg, shift = 0, mask, ret;
 285
 286         ret = max8998_get_voltage_register(rdev, &reg, &shift, &mask);
 287         if (ret)
 288                 return ret;
 289
 290         ret = max8998_update_reg(i2c, reg, selector<<shift, mask<<shift);
 291
 292         return ret;
 293 }
 294
 295 static inline void buck1_gpio_set(int gpio1, int gpio2, int v)
 296 {
 297         gpio_set_value(gpio1, v & 0x1);
 298         gpio_set_value(gpio2, (v >> 1) & 0x1);
 299 }
 300
 301 static inline void buck2_gpio_set(int gpio, int v)
 302 {
 303         gpio_set_value(gpio, v & 0x1);
 304 }
 305
 306 static int max8998_set_voltage_buck_sel(struct regulator_dev *rdev,
 307                                         unsigned selector)
 308 {
 309         struct max8998_data *max8998 = rdev_get_drvdata(rdev);
 310         struct max8998_platform_data *pdata =
 311                 dev_get_platdata(max8998->iodev->dev);
 312         struct i2c_client *i2c = max8998->iodev->i2c;
 313         int buck = rdev_get_id(rdev);
 314         int reg, shift = 0, mask, ret, j;
 315         static u8 buck1_last_val;
 316
 317         ret = max8998_get_voltage_register(rdev, &reg, &shift, &mask);
 318         if (ret)
 319                 return ret;
 320
 321         switch (buck) {
 322         case MAX8998_BUCK1:
 323                 dev_dbg(max8998->dev,
 324                         "BUCK1, selector:%d, buck1_vol1:%d, buck1_vol2:%d\n"
 325                         "buck1_vol3:%d, buck1_vol4:%d\n",
 326                         selector, max8998->buck1_vol[0], max8998->buck1_vol[1],
 327                         max8998->buck1_vol[2], max8998->buck1_vol[3]);
 328
 329                 if (gpio_is_valid(pdata->buck1_set1) &&
 330                     gpio_is_valid(pdata->buck1_set2)) {
 331
 332                         /* check if requested voltage */
 333                         /* value is already defined */
 334                         for (j = 0; j < ARRAY_SIZE(max8998->buck1_vol); j++) {
 335                                 if (max8998->buck1_vol[j] == selector) {
 336                                         max8998->buck1_idx = j;
 337                                         buck1_gpio_set(pdata->buck1_set1,
 338                                                        pdata->buck1_set2, j);
 339                                         goto buck1_exit;
 340                                 }
 341                         }
 342
 343                         if (pdata->buck_voltage_lock)
 344                                 return -EINVAL;
 345
 346                         /* no predefine regulator found */
 347                         max8998->buck1_idx = (buck1_last_val % 2) + 2;
 348                         dev_dbg(max8998->dev, "max8998->buck1_idx:%d\n",
 349                                 max8998->buck1_idx);
 350                         max8998->buck1_vol[max8998->buck1_idx] = selector;
 351                         ret = max8998_get_voltage_register(rdev, &reg,
 352                                                            &shift,
 353                                                            &mask);
 354                         ret = max8998_write_reg(i2c, reg, selector);
 355                         buck1_gpio_set(pdata->buck1_set1,
 356                                        pdata->buck1_set2, max8998->buck1_idx);
 357                         buck1_last_val++;
 358 buck1_exit:
 359                         dev_dbg(max8998->dev, "%s: SET1:%d, SET2:%d\n",
 360                                 i2c->name, gpio_get_value(pdata->buck1_set1),
 361                                 gpio_get_value(pdata->buck1_set2));
 362                         break;
 363                 } else {
 364                         ret = max8998_write_reg(i2c, reg, selector);
 365                 }
 366                 break;
 367
 368         case MAX8998_BUCK2:
 369                 dev_dbg(max8998->dev,
 370                         "BUCK2, selector:%d buck2_vol1:%d, buck2_vol2:%d\n",
 371                         selector, max8998->buck2_vol[0], max8998->buck2_vol[1]);
 372                 if (gpio_is_valid(pdata->buck2_set3)) {
 373
 374                         /* check if requested voltage */
 375                         /* value is already defined */
 376                         for (j = 0; j < ARRAY_SIZE(max8998->buck2_vol); j++) {
 377                                 if (max8998->buck2_vol[j] == selector) {
 378                                         max8998->buck2_idx = j;
 379                                         buck2_gpio_set(pdata->buck2_set3, j);
 380                                         goto buck2_exit;
 381                                 }
 382                         }
 383
 384                         if (pdata->buck_voltage_lock)
 385                                 return -EINVAL;
 386
 387                         max8998_get_voltage_register(rdev,
 388                                         &reg, &shift, &mask);
 389                         ret = max8998_write_reg(i2c, reg, selector);
 390                         max8998->buck2_vol[max8998->buck2_idx] = selector;
 391                         buck2_gpio_set(pdata->buck2_set3, max8998->buck2_idx);
 392 buck2_exit:
 393                         dev_dbg(max8998->dev, "%s: SET3:%d\n", i2c->name,
 394                                 gpio_get_value(pdata->buck2_set3));
 395                 } else {
 396                         ret = max8998_write_reg(i2c, reg, selector);
 397                 }
 398                 break;
 399
 400         case MAX8998_BUCK3:
 401         case MAX8998_BUCK4:
 402                 ret = max8998_update_reg(i2c, reg, selector<<shift,
 403                                          mask<<shift);
 404                 break;
 405         }
 406
 407         return ret;
 408 }
 409
 410 static int max8998_set_voltage_buck_time_sel(struct regulator_dev *rdev,
 411                                              unsigned int old_selector,
 412                                              unsigned int new_selector)
 413 {
 414         struct max8998_data *max8998 = rdev_get_drvdata(rdev);
 415         struct i2c_client *i2c = max8998->iodev->i2c;
 416         const struct voltage_map_desc *desc;
 417         int buck = rdev_get_id(rdev);
 418         u8 val = 0;
 419         int difference, ret;
 420
 421         if (buck < MAX8998_BUCK1 || buck > MAX8998_BUCK4)
 422                 return -EINVAL;
 423
 424         desc = ldo_voltage_map[buck];
 425
 426         /* Voltage stabilization */
 427         ret = max8998_read_reg(i2c, MAX8998_REG_ONOFF4, &val);
 428         if (ret)
 429                 return ret;
 430
 431         /* lp3974 hasn't got ENRAMP bit - ramp is assumed as true */
 432         /* MAX8998 has ENRAMP bit implemented, so test it*/
 433         if (max8998->iodev->type == TYPE_MAX8998 && !(val & MAX8998_ENRAMP))
 434                 return 0;
 435
 436         difference = (new_selector - old_selector) * desc->step / 1000;
 437         if (difference > 0)
 438                 return DIV_ROUND_UP(difference, (val & 0x0f) + 1);
 439
 440         return 0;
 441 }
 442
 443 static struct regulator_ops max8998_ldo_ops = {
 444         .list_voltage           = regulator_list_voltage_linear,
 445         .map_voltage            = regulator_map_voltage_linear,
 446         .is_enabled             = max8998_ldo_is_enabled,
 447         .enable                 = max8998_ldo_enable,
 448         .disable                = max8998_ldo_disable,
 449         .get_voltage_sel        = max8998_get_voltage_sel,
 450         .set_voltage_sel        = max8998_set_voltage_ldo_sel,
 451 };
 452
 453 static struct regulator_ops max8998_buck_ops = {
 454         .list_voltage           = regulator_list_voltage_linear,
 455         .map_voltage            = regulator_map_voltage_linear,
 456         .is_enabled             = max8998_ldo_is_enabled,
 457         .enable                 = max8998_ldo_enable,
 458         .disable                = max8998_ldo_disable,
 459         .get_voltage_sel        = max8998_get_voltage_sel,
 460         .set_voltage_sel        = max8998_set_voltage_buck_sel,
 461         .set_voltage_time_sel   = max8998_set_voltage_buck_time_sel,
 462 };
 463
 464 static struct regulator_ops max8998_others_ops = {
 465         .is_enabled             = max8998_ldo_is_enabled,
 466         .enable                 = max8998_ldo_enable,
 467         .disable                = max8998_ldo_disable,
 468 };
 469
 470 static struct regulator_desc regulators[] = {
 471         {
 472                 .name           = "LDO2",
 473                 .id             = MAX8998_LDO2,
 474                 .ops            = &max8998_ldo_ops,
 475                 .type           = REGULATOR_VOLTAGE,
 476                 .owner          = THIS_MODULE,
 477         }, {
 478                 .name           = "LDO3",
 479                 .id             = MAX8998_LDO3,
 480                 .ops            = &max8998_ldo_ops,
 481                 .type           = REGULATOR_VOLTAGE,
 482                 .owner          = THIS_MODULE,
 483         }, {
 484                 .name           = "LDO4",
 485                 .id             = MAX8998_LDO4,
 486                 .ops            = &max8998_ldo_ops,
 487                 .type           = REGULATOR_VOLTAGE,
 488                 .owner          = THIS_MODULE,
 489         }, {
 490                 .name           = "LDO5",
 491                 .id             = MAX8998_LDO5,
 492                 .ops            = &max8998_ldo_ops,
 493                 .type           = REGULATOR_VOLTAGE,
 494                 .owner          = THIS_MODULE,
 495         }, {
 496                 .name           = "LDO6",
 497                 .id             = MAX8998_LDO6,
 498                 .ops            = &max8998_ldo_ops,
 499                 .type           = REGULATOR_VOLTAGE,
 500                 .owner          = THIS_MODULE,
 501         }, {
 502                 .name           = "LDO7",
 503                 .id             = MAX8998_LDO7,
 504                 .ops            = &max8998_ldo_ops,
 505                 .type           = REGULATOR_VOLTAGE,
 506                 .owner          = THIS_MODULE,
 507         }, {
 508                 .name           = "LDO8",
 509                 .id             = MAX8998_LDO8,
 510                 .ops            = &max8998_ldo_ops,
 511                 .type           = REGULATOR_VOLTAGE,
 512                 .owner          = THIS_MODULE,
 513         }, {
 514                 .name           = "LDO9",
 515                 .id             = MAX8998_LDO9,
 516                 .ops            = &max8998_ldo_ops,
 517                 .type           = REGULATOR_VOLTAGE,
 518                 .owner          = THIS_MODULE,
 519         }, {
 520                 .name           = "LDO10",
 521                 .id             = MAX8998_LDO10,
 522                 .ops            = &max8998_ldo_ops,
 523                 .type           = REGULATOR_VOLTAGE,
 524                 .owner          = THIS_MODULE,
 525         }, {
 526                 .name           = "LDO11",
 527                 .id             = MAX8998_LDO11,
 528                 .ops            = &max8998_ldo_ops,
 529                 .type           = REGULATOR_VOLTAGE,
 530                 .owner          = THIS_MODULE,
 531         }, {
 532                 .name           = "LDO12",
 533                 .id             = MAX8998_LDO12,
 534                 .ops            = &max8998_ldo_ops,
 535                 .type           = REGULATOR_VOLTAGE,
 536                 .owner          = THIS_MODULE,
 537         }, {
 538                 .name           = "LDO13",
 539                 .id             = MAX8998_LDO13,
 540                 .ops            = &max8998_ldo_ops,
 541                 .type           = REGULATOR_VOLTAGE,
 542                 .owner          = THIS_MODULE,
 543         }, {
 544                 .name           = "LDO14",
 545                 .id             = MAX8998_LDO14,
 546                 .ops            = &max8998_ldo_ops,
 547                 .type           = REGULATOR_VOLTAGE,
 548                 .owner          = THIS_MODULE,
 549         }, {
 550                 .name           = "LDO15",
 551                 .id             = MAX8998_LDO15,
 552                 .ops            = &max8998_ldo_ops,
 553                 .type           = REGULATOR_VOLTAGE,
 554                 .owner          = THIS_MODULE,
 555         }, {
 556                 .name           = "LDO16",
 557                 .id             = MAX8998_LDO16,
 558                 .ops            = &max8998_ldo_ops,
 559                 .type           = REGULATOR_VOLTAGE,
 560                 .owner          = THIS_MODULE,
 561         }, {
 562                 .name           = "LDO17",
 563                 .id             = MAX8998_LDO17,
 564                 .ops            = &max8998_ldo_ops,
 565                 .type           = REGULATOR_VOLTAGE,
 566                 .owner          = THIS_MODULE,
 567         }, {
 568                 .name           = "BUCK1",
 569                 .id             = MAX8998_BUCK1,
 570                 .ops            = &max8998_buck_ops,
 571                 .type           = REGULATOR_VOLTAGE,
 572                 .owner          = THIS_MODULE,
 573         }, {
 574                 .name           = "BUCK2",
 575                 .id             = MAX8998_BUCK2,
 576                 .ops            = &max8998_buck_ops,
 577                 .type           = REGULATOR_VOLTAGE,
 578                 .owner          = THIS_MODULE,
 579         }, {
 580                 .name           = "BUCK3",
 581                 .id             = MAX8998_BUCK3,
 582                 .ops            = &max8998_buck_ops,
 583                 .type           = REGULATOR_VOLTAGE,
 584                 .owner          = THIS_MODULE,
 585         }, {
 586                 .name           = "BUCK4",
 587                 .id             = MAX8998_BUCK4,
 588                 .ops            = &max8998_buck_ops,
 589                 .type           = REGULATOR_VOLTAGE,
 590                 .owner          = THIS_MODULE,
 591         }, {
 592                 .name           = "EN32KHz AP",
 593                 .id             = MAX8998_EN32KHZ_AP,
 594                 .ops            = &max8998_others_ops,
 595                 .type           = REGULATOR_VOLTAGE,
 596                 .owner          = THIS_MODULE,
 597         }, {
 598                 .name           = "EN32KHz CP",
 599                 .id             = MAX8998_EN32KHZ_CP,
 600                 .ops            = &max8998_others_ops,
 601                 .type           = REGULATOR_VOLTAGE,
 602                 .owner          = THIS_MODULE,
 603         }, {
 604                 .name           = "ENVICHG",
 605                 .id             = MAX8998_ENVICHG,
 606                 .ops            = &max8998_others_ops,
 607                 .type           = REGULATOR_VOLTAGE,
 608                 .owner          = THIS_MODULE,
 609         }, {
 610                 .name           = "ESAFEOUT1",
 611                 .id             = MAX8998_ESAFEOUT1,
 612                 .ops            = &max8998_others_ops,
 613                 .type           = REGULATOR_VOLTAGE,
 614                 .owner          = THIS_MODULE,
 615         }, {
 616                 .name           = "ESAFEOUT2",
 617                 .id             = MAX8998_ESAFEOUT2,
 618                 .ops            = &max8998_others_ops,
 619                 .type           = REGULATOR_VOLTAGE,
 620                 .owner          = THIS_MODULE,
 621         }
 622 };
 623
 624 static int max8998_pmic_probe(struct platform_device *pdev)
 625 {
 626         struct max8998_dev *iodev = dev_get_drvdata(pdev->dev.parent);
 627         struct max8998_platform_data *pdata = dev_get_platdata(iodev->dev);
 628         struct regulator_config config = { };
 629         struct regulator_dev **rdev;
 630         struct max8998_data *max8998;
 631         struct i2c_client *i2c;
 632         int i, ret, size;
 633
 634         if (!pdata) {
 635                 dev_err(pdev->dev.parent, "No platform init data supplied\n");
 636                 return -ENODEV;
 637         }
 638
 639         max8998 = devm_kzalloc(&pdev->dev, sizeof(struct max8998_data),
 640                                GFP_KERNEL);
 641         if (!max8998)
 642                 return -ENOMEM;
 643
 644         size = sizeof(struct regulator_dev *) * pdata->num_regulators;
 645         max8998->rdev = devm_kzalloc(&pdev->dev, size, GFP_KERNEL);
 646         if (!max8998->rdev)
 647                 return -ENOMEM;
 648
 649         rdev = max8998->rdev;
 650         max8998->dev = &pdev->dev;
 651         max8998->iodev = iodev;
 652         max8998->num_regulators = pdata->num_regulators;
 653         platform_set_drvdata(pdev, max8998);
 654         i2c = max8998->iodev->i2c;
 655
 656         max8998->buck1_idx = pdata->buck1_default_idx;
 657         max8998->buck2_idx = pdata->buck2_default_idx;
 658
 659         /* NOTE: */
 660         /* For unused GPIO NOT marked as -1 (thereof equal to 0)  WARN_ON */
 661         /* will be displayed */
 662
 663         /* Check if MAX8998 voltage selection GPIOs are defined */
 664         if (gpio_is_valid(pdata->buck1_set1) &&
 665             gpio_is_valid(pdata->buck1_set2)) {
 666                 /* Check if SET1 is not equal to 0 */
 667                 if (!pdata->buck1_set1) {
 668                         printk(KERN_ERR "MAX8998 SET1 GPIO defined as 0 !\n");
 669                         WARN_ON(!pdata->buck1_set1);
 670                         ret = -EIO;
 671                         goto err_out;
 672                 }
 673                 /* Check if SET2 is not equal to 0 */
 674                 if (!pdata->buck1_set2) {
 675                         printk(KERN_ERR "MAX8998 SET2 GPIO defined as 0 !\n");
 676                         WARN_ON(!pdata->buck1_set2);
 677                         ret = -EIO;
 678                         goto err_out;
 679                 }
 680
 681                 gpio_request(pdata->buck1_set1, "MAX8998 BUCK1_SET1");
 682                 gpio_direction_output(pdata->buck1_set1,
 683                                       max8998->buck1_idx & 0x1);
 684
 685
 686                 gpio_request(pdata->buck1_set2, "MAX8998 BUCK1_SET2");
 687                 gpio_direction_output(pdata->buck1_set2,
 688                                       (max8998->buck1_idx >> 1) & 0x1);
 689                 /* Set predefined value for BUCK1 register 1 */
 690                 i = 0;
 691                 while (buck12_voltage_map_desc.min +
 692                        buck12_voltage_map_desc.step*i
 693                        < pdata->buck1_voltage1)
 694                         i++;
 695                 max8998->buck1_vol[0] = i;
 696                 ret = max8998_write_reg(i2c, MAX8998_REG_BUCK1_VOLTAGE1, i);
 697                 if (ret)
 698                         goto err_out;
 699
 700                 /* Set predefined value for BUCK1 register 2 */
 701                 i = 0;
 702                 while (buck12_voltage_map_desc.min +
 703                        buck12_voltage_map_desc.step*i
 704                        < pdata->buck1_voltage2)
 705                         i++;
 706
 707                 max8998->buck1_vol[1] = i;
 708                 ret = max8998_write_reg(i2c, MAX8998_REG_BUCK1_VOLTAGE2, i);
 709                 if (ret)
 710                         goto err_out;
 711
 712                 /* Set predefined value for BUCK1 register 3 */
 713                 i = 0;
 714                 while (buck12_voltage_map_desc.min +
 715                        buck12_voltage_map_desc.step*i
 716                        < pdata->buck1_voltage3)
 717                         i++;
 718
 719                 max8998->buck1_vol[2] = i;
 720                 ret = max8998_write_reg(i2c, MAX8998_REG_BUCK1_VOLTAGE3, i);
 721                 if (ret)
 722                         goto err_out;
 723
 724                 /* Set predefined value for BUCK1 register 4 */
 725                 i = 0;
 726                 while (buck12_voltage_map_desc.min +
 727                        buck12_voltage_map_desc.step*i
 728                        < pdata->buck1_voltage4)
 729                         i++;
 730
 731                 max8998->buck1_vol[3] = i;
 732                 ret = max8998_write_reg(i2c, MAX8998_REG_BUCK1_VOLTAGE4, i);
 733                 if (ret)
 734                         goto err_out;
 735
 736         }
 737
 738         if (gpio_is_valid(pdata->buck2_set3)) {
 739                 /* Check if SET3 is not equal to 0 */
 740                 if (!pdata->buck2_set3) {
 741                         printk(KERN_ERR "MAX8998 SET3 GPIO defined as 0 !\n");
 742                         WARN_ON(!pdata->buck2_set3);
 743                         ret = -EIO;
 744                         goto err_out;
 745                 }
 746                 gpio_request(pdata->buck2_set3, "MAX8998 BUCK2_SET3");
 747                 gpio_direction_output(pdata->buck2_set3,
 748                                       max8998->buck2_idx & 0x1);
 749
 750                 /* BUCK2 register 1 */
 751                 i = 0;
 752                 while (buck12_voltage_map_desc.min +
 753                        buck12_voltage_map_desc.step*i
 754                        < pdata->buck2_voltage1)
 755                         i++;
 756                 max8998->buck2_vol[0] = i;
 757                 ret = max8998_write_reg(i2c, MAX8998_REG_BUCK2_VOLTAGE1, i);
 758                 if (ret)
 759                         goto err_out;
 760
 761                 /* BUCK2 register 2 */
 762                 i = 0;
 763                 while (buck12_voltage_map_desc.min +
 764                        buck12_voltage_map_desc.step*i
 765                        < pdata->buck2_voltage2)
 766                         i++;
 767                 max8998->buck2_vol[1] = i;
 768                 ret = max8998_write_reg(i2c, MAX8998_REG_BUCK2_VOLTAGE2, i);
 769                 if (ret)
 770                         goto err_out;
 771         }
 772
 773         for (i = 0; i < pdata->num_regulators; i++) {
 774                 const struct voltage_map_desc *desc;
 775                 int id = pdata->regulators[i].id;
 776                 int index = id - MAX8998_LDO2;
 777
 778                 desc = ldo_voltage_map[id];
 779                 if (desc && regulators[index].ops != &max8998_others_ops) {
 780                         int count = (desc->max - desc->min) / desc->step + 1;
 781
 782                         regulators[index].n_voltages = count;
 783                         regulators[index].min_uV = desc->min;
 784                         regulators[index].uV_step = desc->step;
 785                 }
 786
 787                 config.dev = max8998->dev;
 788                 config.init_data = pdata->regulators[i].initdata;
 789                 config.driver_data = max8998;
 790
 791                 rdev[i] = regulator_register(&regulators[index], &config);
 792                 if (IS_ERR(rdev[i])) {
 793                         ret = PTR_ERR(rdev[i]);
 794                         dev_err(max8998->dev, "regulator init failed\n");
 795                         rdev[i] = NULL;
 796                         goto err;
 797                 }
 798         }
 799
 800
 801         return 0;
 802 err:
 803         while (--i >= 0)
 804                 regulator_unregister(rdev[i]);
 805 err_out:
 806         return ret;
 807 }
 808
 809 static int max8998_pmic_remove(struct platform_device *pdev)
 810 {
 811         struct max8998_data *max8998 = platform_get_drvdata(pdev);
 812         struct regulator_dev **rdev = max8998->rdev;
 813         int i;
 814
 815         for (i = 0; i < max8998->num_regulators; i++)
 816                 regulator_unregister(rdev[i]);
 817         return 0;
 818 }
 819
 820 static const struct platform_device_id max8998_pmic_id[] = {
 821         { "max8998-pmic", TYPE_MAX8998 },
 822         { "lp3974-pmic", TYPE_LP3974 },
 823         { }
 824 };
 825 MODULE_DEVICE_TABLE(platform, max8998_pmic_id);
 826
 827 static struct platform_driver max8998_pmic_driver = {
 828         .driver = {
 829                 .name = "max8998-pmic",
 830                 .owner = THIS_MODULE,
 831         },
 832         .probe = max8998_pmic_probe,
 833         .remove = max8998_pmic_remove,
 834         .id_table = max8998_pmic_id,
 835 };
 836
 837 static int __init max8998_pmic_init(void)
 838 {
 839         return platform_driver_register(&max8998_pmic_driver);
 840 }
 841 subsys_initcall(max8998_pmic_init);
 842
 843 static void __exit max8998_pmic_cleanup(void)
 844 {
 845         platform_driver_unregister(&max8998_pmic_driver);
 846 }
 847 module_exit(max8998_pmic_cleanup);
 848
 849 MODULE_DESCRIPTION("MAXIM 8998 voltage regulator driver");
 850 MODULE_AUTHOR("Kyungmin Park <[email protected]>");
 851 MODULE_LICENSE("GPL");