linux/drivers/regulator/max8997.c
<<
>>
Prefs
   1/*
   2 * max8997.c - Regulator driver for the Maxim 8997/8966
   3 *
   4 * Copyright (C) 2011 Samsung Electronics
   5 * MyungJoo Ham <myungjoo.ham@smasung.com>
   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 as published by
   9 * the Free Software Foundation; either version 2 of the License, or
  10 * (at your option) any later version.
  11 *
  12 * This program is distributed in the hope that it will be useful,
  13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15 * GNU General Public License for more details.
  16 *
  17 * You should have received a copy of the GNU General Public License
  18 * along with this program; if not, write to the Free Software
  19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  20 *
  21 * This driver is based on max8998.c
  22 */
  23
  24#include <linux/bug.h>
  25#include <linux/err.h>
  26#include <linux/gpio.h>
  27#include <linux/of_gpio.h>
  28#include <linux/slab.h>
  29#include <linux/module.h>
  30#include <linux/platform_device.h>
  31#include <linux/regulator/driver.h>
  32#include <linux/regulator/machine.h>
  33#include <linux/mfd/max8997.h>
  34#include <linux/mfd/max8997-private.h>
  35#include <linux/regulator/of_regulator.h>
  36
  37struct max8997_data {
  38        struct device *dev;
  39        struct max8997_dev *iodev;
  40        int num_regulators;
  41        struct regulator_dev **rdev;
  42        int ramp_delay; /* in mV/us */
  43
  44        bool buck1_gpiodvs;
  45        bool buck2_gpiodvs;
  46        bool buck5_gpiodvs;
  47        u8 buck1_vol[8];
  48        u8 buck2_vol[8];
  49        u8 buck5_vol[8];
  50        int buck125_gpios[3];
  51        int buck125_gpioindex;
  52        bool ignore_gpiodvs_side_effect;
  53
  54        u8 saved_states[MAX8997_REG_MAX];
  55};
  56
  57static const unsigned int safeoutvolt[] = {
  58        4850000,
  59        4900000,
  60        4950000,
  61        3300000,
  62};
  63
  64static inline void max8997_set_gpio(struct max8997_data *max8997)
  65{
  66        int set3 = (max8997->buck125_gpioindex) & 0x1;
  67        int set2 = ((max8997->buck125_gpioindex) >> 1) & 0x1;
  68        int set1 = ((max8997->buck125_gpioindex) >> 2) & 0x1;
  69
  70        gpio_set_value(max8997->buck125_gpios[0], set1);
  71        gpio_set_value(max8997->buck125_gpios[1], set2);
  72        gpio_set_value(max8997->buck125_gpios[2], set3);
  73}
  74
  75struct voltage_map_desc {
  76        int min;
  77        int max;
  78        int step;
  79};
  80
  81/* Voltage maps in uV */
  82static const struct voltage_map_desc ldo_voltage_map_desc = {
  83        .min = 800000,  .max = 3950000, .step = 50000,
  84}; /* LDO1 ~ 18, 21 all */
  85
  86static const struct voltage_map_desc buck1245_voltage_map_desc = {
  87        .min = 650000,  .max = 2225000, .step = 25000,
  88}; /* Buck1, 2, 4, 5 */
  89
  90static const struct voltage_map_desc buck37_voltage_map_desc = {
  91        .min = 750000,  .max = 3900000, .step = 50000,
  92}; /* Buck3, 7 */
  93
  94/* current map in uA */
  95static const struct voltage_map_desc charger_current_map_desc = {
  96        .min = 200000,  .max = 950000,  .step = 50000,
  97};
  98
  99static const struct voltage_map_desc topoff_current_map_desc = {
 100        .min = 50000,   .max = 200000,  .step = 10000,
 101};
 102
 103static const struct voltage_map_desc *reg_voltage_map[] = {
 104        [MAX8997_LDO1] = &ldo_voltage_map_desc,
 105        [MAX8997_LDO2] = &ldo_voltage_map_desc,
 106        [MAX8997_LDO3] = &ldo_voltage_map_desc,
 107        [MAX8997_LDO4] = &ldo_voltage_map_desc,
 108        [MAX8997_LDO5] = &ldo_voltage_map_desc,
 109        [MAX8997_LDO6] = &ldo_voltage_map_desc,
 110        [MAX8997_LDO7] = &ldo_voltage_map_desc,
 111        [MAX8997_LDO8] = &ldo_voltage_map_desc,
 112        [MAX8997_LDO9] = &ldo_voltage_map_desc,
 113        [MAX8997_LDO10] = &ldo_voltage_map_desc,
 114        [MAX8997_LDO11] = &ldo_voltage_map_desc,
 115        [MAX8997_LDO12] = &ldo_voltage_map_desc,
 116        [MAX8997_LDO13] = &ldo_voltage_map_desc,
 117        [MAX8997_LDO14] = &ldo_voltage_map_desc,
 118        [MAX8997_LDO15] = &ldo_voltage_map_desc,
 119        [MAX8997_LDO16] = &ldo_voltage_map_desc,
 120        [MAX8997_LDO17] = &ldo_voltage_map_desc,
 121        [MAX8997_LDO18] = &ldo_voltage_map_desc,
 122        [MAX8997_LDO21] = &ldo_voltage_map_desc,
 123        [MAX8997_BUCK1] = &buck1245_voltage_map_desc,
 124        [MAX8997_BUCK2] = &buck1245_voltage_map_desc,
 125        [MAX8997_BUCK3] = &buck37_voltage_map_desc,
 126        [MAX8997_BUCK4] = &buck1245_voltage_map_desc,
 127        [MAX8997_BUCK5] = &buck1245_voltage_map_desc,
 128        [MAX8997_BUCK6] = NULL,
 129        [MAX8997_BUCK7] = &buck37_voltage_map_desc,
 130        [MAX8997_EN32KHZ_AP] = NULL,
 131        [MAX8997_EN32KHZ_CP] = NULL,
 132        [MAX8997_ENVICHG] = NULL,
 133        [MAX8997_ESAFEOUT1] = NULL,
 134        [MAX8997_ESAFEOUT2] = NULL,
 135        [MAX8997_CHARGER_CV] = NULL,
 136        [MAX8997_CHARGER] = &charger_current_map_desc,
 137        [MAX8997_CHARGER_TOPOFF] = &topoff_current_map_desc,
 138};
 139
 140static int max8997_list_voltage_charger_cv(struct regulator_dev *rdev,
 141                unsigned int selector)
 142{
 143        int rid = rdev_get_id(rdev);
 144
 145        if (rid != MAX8997_CHARGER_CV)
 146                goto err;
 147
 148        switch (selector) {
 149        case 0x00:
 150                return 4200000;
 151        case 0x01 ... 0x0E:
 152                return 4000000 + 20000 * (selector - 0x01);
 153        case 0x0F:
 154                return 4350000;
 155        default:
 156                return -EINVAL;
 157        }
 158err:
 159        return -EINVAL;
 160}
 161
 162static int max8997_list_voltage(struct regulator_dev *rdev,
 163                unsigned int selector)
 164{
 165        const struct voltage_map_desc *desc;
 166        int rid = rdev_get_id(rdev);
 167        int val;
 168
 169        if (rid >= ARRAY_SIZE(reg_voltage_map) ||
 170                        rid < 0)
 171                return -EINVAL;
 172
 173        desc = reg_voltage_map[rid];
 174        if (desc == NULL)
 175                return -EINVAL;
 176
 177        val = desc->min + desc->step * selector;
 178        if (val > desc->max)
 179                return -EINVAL;
 180
 181        return val;
 182}
 183
 184static int max8997_get_enable_register(struct regulator_dev *rdev,
 185                int *reg, int *mask, int *pattern)
 186{
 187        int rid = rdev_get_id(rdev);
 188
 189        switch (rid) {
 190        case MAX8997_LDO1 ... MAX8997_LDO21:
 191                *reg = MAX8997_REG_LDO1CTRL + (rid - MAX8997_LDO1);
 192                *mask = 0xC0;
 193                *pattern = 0xC0;
 194                break;
 195        case MAX8997_BUCK1:
 196                *reg = MAX8997_REG_BUCK1CTRL;
 197                *mask = 0x01;
 198                *pattern = 0x01;
 199                break;
 200        case MAX8997_BUCK2:
 201                *reg = MAX8997_REG_BUCK2CTRL;
 202                *mask = 0x01;
 203                *pattern = 0x01;
 204                break;
 205        case MAX8997_BUCK3:
 206                *reg = MAX8997_REG_BUCK3CTRL;
 207                *mask = 0x01;
 208                *pattern = 0x01;
 209                break;
 210        case MAX8997_BUCK4:
 211                *reg = MAX8997_REG_BUCK4CTRL;
 212                *mask = 0x01;
 213                *pattern = 0x01;
 214                break;
 215        case MAX8997_BUCK5:
 216                *reg = MAX8997_REG_BUCK5CTRL;
 217                *mask = 0x01;
 218                *pattern = 0x01;
 219                break;
 220        case MAX8997_BUCK6:
 221                *reg = MAX8997_REG_BUCK6CTRL;
 222                *mask = 0x01;
 223                *pattern = 0x01;
 224                break;
 225        case MAX8997_BUCK7:
 226                *reg = MAX8997_REG_BUCK7CTRL;
 227                *mask = 0x01;
 228                *pattern = 0x01;
 229                break;
 230        case MAX8997_EN32KHZ_AP ... MAX8997_EN32KHZ_CP:
 231                *reg = MAX8997_REG_MAINCON1;
 232                *mask = 0x01 << (rid - MAX8997_EN32KHZ_AP);
 233                *pattern = 0x01 << (rid - MAX8997_EN32KHZ_AP);
 234                break;
 235        case MAX8997_ENVICHG:
 236                *reg = MAX8997_REG_MBCCTRL1;
 237                *mask = 0x80;
 238                *pattern = 0x80;
 239                break;
 240        case MAX8997_ESAFEOUT1 ... MAX8997_ESAFEOUT2:
 241                *reg = MAX8997_REG_SAFEOUTCTRL;
 242                *mask = 0x40 << (rid - MAX8997_ESAFEOUT1);
 243                *pattern = 0x40 << (rid - MAX8997_ESAFEOUT1);
 244                break;
 245        case MAX8997_CHARGER:
 246                *reg = MAX8997_REG_MBCCTRL2;
 247                *mask = 0x40;
 248                *pattern = 0x40;
 249                break;
 250        default:
 251                /* Not controllable or not exists */
 252                return -EINVAL;
 253        }
 254
 255        return 0;
 256}
 257
 258static int max8997_reg_is_enabled(struct regulator_dev *rdev)
 259{
 260        struct max8997_data *max8997 = rdev_get_drvdata(rdev);
 261        struct i2c_client *i2c = max8997->iodev->i2c;
 262        int ret, reg, mask, pattern;
 263        u8 val;
 264
 265        ret = max8997_get_enable_register(rdev, &reg, &mask, &pattern);
 266        if (ret)
 267                return ret;
 268
 269        ret = max8997_read_reg(i2c, reg, &val);
 270        if (ret)
 271                return ret;
 272
 273        return (val & mask) == pattern;
 274}
 275
 276static int max8997_reg_enable(struct regulator_dev *rdev)
 277{
 278        struct max8997_data *max8997 = rdev_get_drvdata(rdev);
 279        struct i2c_client *i2c = max8997->iodev->i2c;
 280        int ret, reg, mask, pattern;
 281
 282        ret = max8997_get_enable_register(rdev, &reg, &mask, &pattern);
 283        if (ret)
 284                return ret;
 285
 286        return max8997_update_reg(i2c, reg, pattern, mask);
 287}
 288
 289static int max8997_reg_disable(struct regulator_dev *rdev)
 290{
 291        struct max8997_data *max8997 = rdev_get_drvdata(rdev);
 292        struct i2c_client *i2c = max8997->iodev->i2c;
 293        int ret, reg, mask, pattern;
 294
 295        ret = max8997_get_enable_register(rdev, &reg, &mask, &pattern);
 296        if (ret)
 297                return ret;
 298
 299        return max8997_update_reg(i2c, reg, ~pattern, mask);
 300}
 301
 302static int max8997_get_voltage_register(struct regulator_dev *rdev,
 303                int *_reg, int *_shift, int *_mask)
 304{
 305        struct max8997_data *max8997 = rdev_get_drvdata(rdev);
 306        int rid = rdev_get_id(rdev);
 307        int reg, shift = 0, mask = 0x3f;
 308
 309        switch (rid) {
 310        case MAX8997_LDO1 ... MAX8997_LDO21:
 311                reg = MAX8997_REG_LDO1CTRL + (rid - MAX8997_LDO1);
 312                break;
 313        case MAX8997_BUCK1:
 314                reg = MAX8997_REG_BUCK1DVS1;
 315                if (max8997->buck1_gpiodvs)
 316                        reg += max8997->buck125_gpioindex;
 317                break;
 318        case MAX8997_BUCK2:
 319                reg = MAX8997_REG_BUCK2DVS1;
 320                if (max8997->buck2_gpiodvs)
 321                        reg += max8997->buck125_gpioindex;
 322                break;
 323        case MAX8997_BUCK3:
 324                reg = MAX8997_REG_BUCK3DVS;
 325                break;
 326        case MAX8997_BUCK4:
 327                reg = MAX8997_REG_BUCK4DVS;
 328                break;
 329        case MAX8997_BUCK5:
 330                reg = MAX8997_REG_BUCK5DVS1;
 331                if (max8997->buck5_gpiodvs)
 332                        reg += max8997->buck125_gpioindex;
 333                break;
 334        case MAX8997_BUCK7:
 335                reg = MAX8997_REG_BUCK7DVS;
 336                break;
 337        case MAX8997_ESAFEOUT1 ...  MAX8997_ESAFEOUT2:
 338                reg = MAX8997_REG_SAFEOUTCTRL;
 339                shift = (rid == MAX8997_ESAFEOUT2) ? 2 : 0;
 340                mask = 0x3;
 341                break;
 342        case MAX8997_CHARGER_CV:
 343                reg = MAX8997_REG_MBCCTRL3;
 344                shift = 0;
 345                mask = 0xf;
 346                break;
 347        case MAX8997_CHARGER:
 348                reg = MAX8997_REG_MBCCTRL4;
 349                shift = 0;
 350                mask = 0xf;
 351                break;
 352        case MAX8997_CHARGER_TOPOFF:
 353                reg = MAX8997_REG_MBCCTRL5;
 354                shift = 0;
 355                mask = 0xf;
 356                break;
 357        default:
 358                return -EINVAL;
 359        }
 360
 361        *_reg = reg;
 362        *_shift = shift;
 363        *_mask = mask;
 364
 365        return 0;
 366}
 367
 368static int max8997_get_voltage_sel(struct regulator_dev *rdev)
 369{
 370        struct max8997_data *max8997 = rdev_get_drvdata(rdev);
 371        struct i2c_client *i2c = max8997->iodev->i2c;
 372        int reg, shift, mask, ret;
 373        u8 val;
 374
 375        ret = max8997_get_voltage_register(rdev, &reg, &shift, &mask);
 376        if (ret)
 377                return ret;
 378
 379        ret = max8997_read_reg(i2c, reg, &val);
 380        if (ret)
 381                return ret;
 382
 383        val >>= shift;
 384        val &= mask;
 385
 386        return val;
 387}
 388
 389static inline int max8997_get_voltage_proper_val(
 390                const struct voltage_map_desc *desc,
 391                int min_vol, int max_vol)
 392{
 393        int i;
 394
 395        if (desc == NULL)
 396                return -EINVAL;
 397
 398        if (max_vol < desc->min || min_vol > desc->max)
 399                return -EINVAL;
 400
 401        if (min_vol < desc->min)
 402                min_vol = desc->min;
 403
 404        i = DIV_ROUND_UP(min_vol - desc->min, desc->step);
 405
 406        if (desc->min + desc->step * i > max_vol)
 407                return -EINVAL;
 408
 409        return i;
 410}
 411
 412static int max8997_set_voltage_charger_cv(struct regulator_dev *rdev,
 413                int min_uV, int max_uV, unsigned *selector)
 414{
 415        struct max8997_data *max8997 = rdev_get_drvdata(rdev);
 416        struct i2c_client *i2c = max8997->iodev->i2c;
 417        int rid = rdev_get_id(rdev);
 418        int lb, ub;
 419        int reg, shift = 0, mask, ret = 0;
 420        u8 val = 0x0;
 421
 422        if (rid != MAX8997_CHARGER_CV)
 423                return -EINVAL;
 424
 425        ret = max8997_get_voltage_register(rdev, &reg, &shift, &mask);
 426        if (ret)
 427                return ret;
 428
 429        if (max_uV < 4000000 || min_uV > 4350000)
 430                return -EINVAL;
 431
 432        if (min_uV <= 4000000) {
 433                if (max_uV >= 4000000)
 434                        return -EINVAL;
 435                else
 436                        val = 0x1;
 437        } else if (min_uV <= 4200000 && max_uV >= 4200000)
 438                val = 0x0;
 439        else {
 440                lb = (min_uV - 4000001) / 20000 + 2;
 441                ub = (max_uV - 4000000) / 20000 + 1;
 442
 443                if (lb > ub)
 444                        return -EINVAL;
 445
 446                if (lb < 0xf)
 447                        val = lb;
 448                else {
 449                        if (ub >= 0xf)
 450                                val = 0xf;
 451                        else
 452                                return -EINVAL;
 453                }
 454        }
 455
 456        *selector = val;
 457
 458        ret = max8997_update_reg(i2c, reg, val << shift, mask);
 459
 460        return ret;
 461}
 462
 463/*
 464 * For LDO1 ~ LDO21, BUCK1~5, BUCK7, CHARGER, CHARGER_TOPOFF
 465 * BUCK1, 2, and 5 are available if they are not controlled by gpio
 466 */
 467static int max8997_set_voltage_ldobuck(struct regulator_dev *rdev,
 468                int min_uV, int max_uV, unsigned *selector)
 469{
 470        struct max8997_data *max8997 = rdev_get_drvdata(rdev);
 471        struct i2c_client *i2c = max8997->iodev->i2c;
 472        const struct voltage_map_desc *desc;
 473        int rid = rdev_get_id(rdev);
 474        int i, reg, shift, mask, ret;
 475
 476        switch (rid) {
 477        case MAX8997_LDO1 ... MAX8997_LDO21:
 478                break;
 479        case MAX8997_BUCK1 ... MAX8997_BUCK5:
 480                break;
 481        case MAX8997_BUCK6:
 482                return -EINVAL;
 483        case MAX8997_BUCK7:
 484                break;
 485        case MAX8997_CHARGER:
 486                break;
 487        case MAX8997_CHARGER_TOPOFF:
 488                break;
 489        default:
 490                return -EINVAL;
 491        }
 492
 493        desc = reg_voltage_map[rid];
 494
 495        i = max8997_get_voltage_proper_val(desc, min_uV, max_uV);
 496        if (i < 0)
 497                return i;
 498
 499        ret = max8997_get_voltage_register(rdev, &reg, &shift, &mask);
 500        if (ret)
 501                return ret;
 502
 503        ret = max8997_update_reg(i2c, reg, i << shift, mask << shift);
 504        *selector = i;
 505
 506        return ret;
 507}
 508
 509static int max8997_set_voltage_buck_time_sel(struct regulator_dev *rdev,
 510                                                unsigned int old_selector,
 511                                                unsigned int new_selector)
 512{
 513        struct max8997_data *max8997 = rdev_get_drvdata(rdev);
 514        int rid = rdev_get_id(rdev);
 515        const struct voltage_map_desc *desc = reg_voltage_map[rid];
 516
 517        /* Delay is required only if the voltage is increasing */
 518        if (old_selector >= new_selector)
 519                return 0;
 520
 521        /* No need to delay if gpio_dvs_mode */
 522        switch (rid) {
 523        case MAX8997_BUCK1:
 524                if (max8997->buck1_gpiodvs)
 525                        return 0;
 526                break;
 527        case MAX8997_BUCK2:
 528                if (max8997->buck2_gpiodvs)
 529                        return 0;
 530                break;
 531        case MAX8997_BUCK5:
 532                if (max8997->buck5_gpiodvs)
 533                        return 0;
 534                break;
 535        }
 536
 537        switch (rid) {
 538        case MAX8997_BUCK1:
 539        case MAX8997_BUCK2:
 540        case MAX8997_BUCK4:
 541        case MAX8997_BUCK5:
 542                return DIV_ROUND_UP(desc->step * (new_selector - old_selector),
 543                                    max8997->ramp_delay * 1000);
 544        }
 545
 546        return 0;
 547}
 548
 549/*
 550 * Assess the damage on the voltage setting of BUCK1,2,5 by the change.
 551 *
 552 * When GPIO-DVS mode is used for multiple bucks, changing the voltage value
 553 * of one of the bucks may affect that of another buck, which is the side
 554 * effect of the change (set_voltage). This function examines the GPIO-DVS
 555 * configurations and checks whether such side-effect exists.
 556 */
 557static int max8997_assess_side_effect(struct regulator_dev *rdev,
 558                u8 new_val, int *best)
 559{
 560        struct max8997_data *max8997 = rdev_get_drvdata(rdev);
 561        int rid = rdev_get_id(rdev);
 562        u8 *buckx_val[3];
 563        bool buckx_gpiodvs[3];
 564        int side_effect[8];
 565        int min_side_effect = INT_MAX;
 566        int i;
 567
 568        *best = -1;
 569
 570        switch (rid) {
 571        case MAX8997_BUCK1:
 572                rid = 0;
 573                break;
 574        case MAX8997_BUCK2:
 575                rid = 1;
 576                break;
 577        case MAX8997_BUCK5:
 578                rid = 2;
 579                break;
 580        default:
 581                return -EINVAL;
 582        }
 583
 584        buckx_val[0] = max8997->buck1_vol;
 585        buckx_val[1] = max8997->buck2_vol;
 586        buckx_val[2] = max8997->buck5_vol;
 587        buckx_gpiodvs[0] = max8997->buck1_gpiodvs;
 588        buckx_gpiodvs[1] = max8997->buck2_gpiodvs;
 589        buckx_gpiodvs[2] = max8997->buck5_gpiodvs;
 590
 591        for (i = 0; i < 8; i++) {
 592                int others;
 593
 594                if (new_val != (buckx_val[rid])[i]) {
 595                        side_effect[i] = -1;
 596                        continue;
 597                }
 598
 599                side_effect[i] = 0;
 600                for (others = 0; others < 3; others++) {
 601                        int diff;
 602
 603                        if (others == rid)
 604                                continue;
 605                        if (buckx_gpiodvs[others] == false)
 606                                continue; /* Not affected */
 607                        diff = (buckx_val[others])[i] -
 608                                (buckx_val[others])[max8997->buck125_gpioindex];
 609                        if (diff > 0)
 610                                side_effect[i] += diff;
 611                        else if (diff < 0)
 612                                side_effect[i] -= diff;
 613                }
 614                if (side_effect[i] == 0) {
 615                        *best = i;
 616                        return 0; /* NO SIDE EFFECT! Use This! */
 617                }
 618                if (side_effect[i] < min_side_effect) {
 619                        min_side_effect = side_effect[i];
 620                        *best = i;
 621                }
 622        }
 623
 624        if (*best == -1)
 625                return -EINVAL;
 626
 627        return side_effect[*best];
 628}
 629
 630/*
 631 * For Buck 1 ~ 5 and 7. If it is not controlled by GPIO, this calls
 632 * max8997_set_voltage_ldobuck to do the job.
 633 */
 634static int max8997_set_voltage_buck(struct regulator_dev *rdev,
 635                int min_uV, int max_uV, unsigned *selector)
 636{
 637        struct max8997_data *max8997 = rdev_get_drvdata(rdev);
 638        int rid = rdev_get_id(rdev);
 639        const struct voltage_map_desc *desc;
 640        int new_val, new_idx, damage, tmp_val, tmp_idx, tmp_dmg;
 641        bool gpio_dvs_mode = false;
 642
 643        if (rid < MAX8997_BUCK1 || rid > MAX8997_BUCK7)
 644                return -EINVAL;
 645
 646        switch (rid) {
 647        case MAX8997_BUCK1:
 648                if (max8997->buck1_gpiodvs)
 649                        gpio_dvs_mode = true;
 650                break;
 651        case MAX8997_BUCK2:
 652                if (max8997->buck2_gpiodvs)
 653                        gpio_dvs_mode = true;
 654                break;
 655        case MAX8997_BUCK5:
 656                if (max8997->buck5_gpiodvs)
 657                        gpio_dvs_mode = true;
 658                break;
 659        }
 660
 661        if (!gpio_dvs_mode)
 662                return max8997_set_voltage_ldobuck(rdev, min_uV, max_uV,
 663                                                selector);
 664
 665        desc = reg_voltage_map[rid];
 666        new_val = max8997_get_voltage_proper_val(desc, min_uV, max_uV);
 667        if (new_val < 0)
 668                return new_val;
 669
 670        tmp_dmg = INT_MAX;
 671        tmp_idx = -1;
 672        tmp_val = -1;
 673        do {
 674                damage = max8997_assess_side_effect(rdev, new_val, &new_idx);
 675                if (damage == 0)
 676                        goto out;
 677
 678                if (tmp_dmg > damage) {
 679                        tmp_idx = new_idx;
 680                        tmp_val = new_val;
 681                        tmp_dmg = damage;
 682                }
 683
 684                new_val++;
 685        } while (desc->min + desc->step * new_val <= desc->max);
 686
 687        new_idx = tmp_idx;
 688        new_val = tmp_val;
 689
 690        if (max8997->ignore_gpiodvs_side_effect == false)
 691                return -EINVAL;
 692
 693        dev_warn(&rdev->dev, "MAX8997 GPIO-DVS Side Effect Warning: GPIO SET:"
 694                        " %d -> %d\n", max8997->buck125_gpioindex, tmp_idx);
 695
 696out:
 697        if (new_idx < 0 || new_val < 0)
 698                return -EINVAL;
 699
 700        max8997->buck125_gpioindex = new_idx;
 701        max8997_set_gpio(max8997);
 702        *selector = new_val;
 703
 704        return 0;
 705}
 706
 707/* For SAFEOUT1 and SAFEOUT2 */
 708static int max8997_set_voltage_safeout_sel(struct regulator_dev *rdev,
 709                                           unsigned selector)
 710{
 711        struct max8997_data *max8997 = rdev_get_drvdata(rdev);
 712        struct i2c_client *i2c = max8997->iodev->i2c;
 713        int rid = rdev_get_id(rdev);
 714        int reg, shift = 0, mask, ret;
 715
 716        if (rid != MAX8997_ESAFEOUT1 && rid != MAX8997_ESAFEOUT2)
 717                return -EINVAL;
 718
 719        ret = max8997_get_voltage_register(rdev, &reg, &shift, &mask);
 720        if (ret)
 721                return ret;
 722
 723        return max8997_update_reg(i2c, reg, selector << shift, mask << shift);
 724}
 725
 726static int max8997_reg_disable_suspend(struct regulator_dev *rdev)
 727{
 728        struct max8997_data *max8997 = rdev_get_drvdata(rdev);
 729        struct i2c_client *i2c = max8997->iodev->i2c;
 730        int ret, reg, mask, pattern;
 731        int rid = rdev_get_id(rdev);
 732
 733        ret = max8997_get_enable_register(rdev, &reg, &mask, &pattern);
 734        if (ret)
 735                return ret;
 736
 737        max8997_read_reg(i2c, reg, &max8997->saved_states[rid]);
 738
 739        if (rid == MAX8997_LDO1 ||
 740                        rid == MAX8997_LDO10 ||
 741                        rid == MAX8997_LDO21) {
 742                dev_dbg(&rdev->dev, "Conditional Power-Off for %s\n",
 743                                rdev->desc->name);
 744                return max8997_update_reg(i2c, reg, 0x40, mask);
 745        }
 746
 747        dev_dbg(&rdev->dev, "Full Power-Off for %s (%xh -> %xh)\n",
 748                        rdev->desc->name, max8997->saved_states[rid] & mask,
 749                        (~pattern) & mask);
 750        return max8997_update_reg(i2c, reg, ~pattern, mask);
 751}
 752
 753static struct regulator_ops max8997_ldo_ops = {
 754        .list_voltage           = max8997_list_voltage,
 755        .is_enabled             = max8997_reg_is_enabled,
 756        .enable                 = max8997_reg_enable,
 757        .disable                = max8997_reg_disable,
 758        .get_voltage_sel        = max8997_get_voltage_sel,
 759        .set_voltage            = max8997_set_voltage_ldobuck,
 760        .set_suspend_disable    = max8997_reg_disable_suspend,
 761};
 762
 763static struct regulator_ops max8997_buck_ops = {
 764        .list_voltage           = max8997_list_voltage,
 765        .is_enabled             = max8997_reg_is_enabled,
 766        .enable                 = max8997_reg_enable,
 767        .disable                = max8997_reg_disable,
 768        .get_voltage_sel        = max8997_get_voltage_sel,
 769        .set_voltage            = max8997_set_voltage_buck,
 770        .set_voltage_time_sel   = max8997_set_voltage_buck_time_sel,
 771        .set_suspend_disable    = max8997_reg_disable_suspend,
 772};
 773
 774static struct regulator_ops max8997_fixedvolt_ops = {
 775        .list_voltage           = max8997_list_voltage,
 776        .is_enabled             = max8997_reg_is_enabled,
 777        .enable                 = max8997_reg_enable,
 778        .disable                = max8997_reg_disable,
 779        .set_suspend_disable    = max8997_reg_disable_suspend,
 780};
 781
 782static struct regulator_ops max8997_safeout_ops = {
 783        .list_voltage           = regulator_list_voltage_table,
 784        .is_enabled             = max8997_reg_is_enabled,
 785        .enable                 = max8997_reg_enable,
 786        .disable                = max8997_reg_disable,
 787        .get_voltage_sel        = max8997_get_voltage_sel,
 788        .set_voltage_sel        = max8997_set_voltage_safeout_sel,
 789        .set_suspend_disable    = max8997_reg_disable_suspend,
 790};
 791
 792static struct regulator_ops max8997_fixedstate_ops = {
 793        .list_voltage           = max8997_list_voltage_charger_cv,
 794        .get_voltage_sel        = max8997_get_voltage_sel,
 795        .set_voltage            = max8997_set_voltage_charger_cv,
 796};
 797
 798static int max8997_set_current_limit(struct regulator_dev *rdev,
 799                                     int min_uA, int max_uA)
 800{
 801        unsigned dummy;
 802        int rid = rdev_get_id(rdev);
 803
 804        if (rid != MAX8997_CHARGER && rid != MAX8997_CHARGER_TOPOFF)
 805                return -EINVAL;
 806
 807        /* Reuse max8997_set_voltage_ldobuck to set current_limit. */
 808        return max8997_set_voltage_ldobuck(rdev, min_uA, max_uA, &dummy);
 809}
 810
 811static int max8997_get_current_limit(struct regulator_dev *rdev)
 812{
 813        int sel, rid = rdev_get_id(rdev);
 814
 815        if (rid != MAX8997_CHARGER && rid != MAX8997_CHARGER_TOPOFF)
 816                return -EINVAL;
 817
 818        sel = max8997_get_voltage_sel(rdev);
 819        if (sel < 0)
 820                return sel;
 821
 822        /* Reuse max8997_list_voltage to get current_limit. */
 823        return max8997_list_voltage(rdev, sel);
 824}
 825
 826static struct regulator_ops max8997_charger_ops = {
 827        .is_enabled             = max8997_reg_is_enabled,
 828        .enable                 = max8997_reg_enable,
 829        .disable                = max8997_reg_disable,
 830        .get_current_limit      = max8997_get_current_limit,
 831        .set_current_limit      = max8997_set_current_limit,
 832};
 833
 834static struct regulator_ops max8997_charger_fixedstate_ops = {
 835        .get_current_limit      = max8997_get_current_limit,
 836        .set_current_limit      = max8997_set_current_limit,
 837};
 838
 839#define MAX8997_VOLTAGE_REGULATOR(_name, _ops) {\
 840        .name           = #_name,               \
 841        .id             = MAX8997_##_name,      \
 842        .ops            = &_ops,                \
 843        .type           = REGULATOR_VOLTAGE,    \
 844        .owner          = THIS_MODULE,          \
 845}
 846
 847#define MAX8997_CURRENT_REGULATOR(_name, _ops) {\
 848        .name           = #_name,               \
 849        .id             = MAX8997_##_name,      \
 850        .ops            = &_ops,                \
 851        .type           = REGULATOR_CURRENT,    \
 852        .owner          = THIS_MODULE,          \
 853}
 854
 855static struct regulator_desc regulators[] = {
 856        MAX8997_VOLTAGE_REGULATOR(LDO1, max8997_ldo_ops),
 857        MAX8997_VOLTAGE_REGULATOR(LDO2, max8997_ldo_ops),
 858        MAX8997_VOLTAGE_REGULATOR(LDO3, max8997_ldo_ops),
 859        MAX8997_VOLTAGE_REGULATOR(LDO4, max8997_ldo_ops),
 860        MAX8997_VOLTAGE_REGULATOR(LDO5, max8997_ldo_ops),
 861        MAX8997_VOLTAGE_REGULATOR(LDO6, max8997_ldo_ops),
 862        MAX8997_VOLTAGE_REGULATOR(LDO7, max8997_ldo_ops),
 863        MAX8997_VOLTAGE_REGULATOR(LDO8, max8997_ldo_ops),
 864        MAX8997_VOLTAGE_REGULATOR(LDO9, max8997_ldo_ops),
 865        MAX8997_VOLTAGE_REGULATOR(LDO10, max8997_ldo_ops),
 866        MAX8997_VOLTAGE_REGULATOR(LDO11, max8997_ldo_ops),
 867        MAX8997_VOLTAGE_REGULATOR(LDO12, max8997_ldo_ops),
 868        MAX8997_VOLTAGE_REGULATOR(LDO13, max8997_ldo_ops),
 869        MAX8997_VOLTAGE_REGULATOR(LDO14, max8997_ldo_ops),
 870        MAX8997_VOLTAGE_REGULATOR(LDO15, max8997_ldo_ops),
 871        MAX8997_VOLTAGE_REGULATOR(LDO16, max8997_ldo_ops),
 872        MAX8997_VOLTAGE_REGULATOR(LDO17, max8997_ldo_ops),
 873        MAX8997_VOLTAGE_REGULATOR(LDO18, max8997_ldo_ops),
 874        MAX8997_VOLTAGE_REGULATOR(LDO21, max8997_ldo_ops),
 875        MAX8997_VOLTAGE_REGULATOR(BUCK1, max8997_buck_ops),
 876        MAX8997_VOLTAGE_REGULATOR(BUCK2, max8997_buck_ops),
 877        MAX8997_VOLTAGE_REGULATOR(BUCK3, max8997_buck_ops),
 878        MAX8997_VOLTAGE_REGULATOR(BUCK4, max8997_buck_ops),
 879        MAX8997_VOLTAGE_REGULATOR(BUCK5, max8997_buck_ops),
 880        MAX8997_VOLTAGE_REGULATOR(BUCK6, max8997_fixedvolt_ops),
 881        MAX8997_VOLTAGE_REGULATOR(BUCK7, max8997_buck_ops),
 882        MAX8997_VOLTAGE_REGULATOR(EN32KHZ_AP, max8997_fixedvolt_ops),
 883        MAX8997_VOLTAGE_REGULATOR(EN32KHZ_CP, max8997_fixedvolt_ops),
 884        MAX8997_VOLTAGE_REGULATOR(ENVICHG, max8997_fixedvolt_ops),
 885        MAX8997_VOLTAGE_REGULATOR(ESAFEOUT1, max8997_safeout_ops),
 886        MAX8997_VOLTAGE_REGULATOR(ESAFEOUT2, max8997_safeout_ops),
 887        MAX8997_VOLTAGE_REGULATOR(CHARGER_CV, max8997_fixedstate_ops),
 888        MAX8997_CURRENT_REGULATOR(CHARGER, max8997_charger_ops),
 889        MAX8997_CURRENT_REGULATOR(CHARGER_TOPOFF,
 890                                  max8997_charger_fixedstate_ops),
 891};
 892
 893#ifdef CONFIG_OF
 894static int max8997_pmic_dt_parse_dvs_gpio(struct platform_device *pdev,
 895                        struct max8997_platform_data *pdata,
 896                        struct device_node *pmic_np)
 897{
 898        int i, gpio;
 899
 900        for (i = 0; i < 3; i++) {
 901                gpio = of_get_named_gpio(pmic_np,
 902                                        "max8997,pmic-buck125-dvs-gpios", i);
 903                if (!gpio_is_valid(gpio)) {
 904                        dev_err(&pdev->dev, "invalid gpio[%d]: %d\n", i, gpio);
 905                        return -EINVAL;
 906                }
 907                pdata->buck125_gpios[i] = gpio;
 908        }
 909        return 0;
 910}
 911
 912static int max8997_pmic_dt_parse_pdata(struct platform_device *pdev,
 913                                        struct max8997_platform_data *pdata)
 914{
 915        struct max8997_dev *iodev = dev_get_drvdata(pdev->dev.parent);
 916        struct device_node *pmic_np, *regulators_np, *reg_np;
 917        struct max8997_regulator_data *rdata;
 918        unsigned int i, dvs_voltage_nr = 1, ret;
 919
 920        pmic_np = of_node_get(iodev->dev->of_node);
 921        if (!pmic_np) {
 922                dev_err(&pdev->dev, "could not find pmic sub-node\n");
 923                return -ENODEV;
 924        }
 925
 926        regulators_np = of_find_node_by_name(pmic_np, "regulators");
 927        if (!regulators_np) {
 928                dev_err(&pdev->dev, "could not find regulators sub-node\n");
 929                return -EINVAL;
 930        }
 931
 932        /* count the number of regulators to be supported in pmic */
 933        pdata->num_regulators = of_get_child_count(regulators_np);
 934
 935        rdata = devm_kzalloc(&pdev->dev, sizeof(*rdata) *
 936                                pdata->num_regulators, GFP_KERNEL);
 937        if (!rdata) {
 938                of_node_put(regulators_np);
 939                dev_err(&pdev->dev, "could not allocate memory for regulator data\n");
 940                return -ENOMEM;
 941        }
 942
 943        pdata->regulators = rdata;
 944        for_each_child_of_node(regulators_np, reg_np) {
 945                for (i = 0; i < ARRAY_SIZE(regulators); i++)
 946                        if (!of_node_cmp(reg_np->name, regulators[i].name))
 947                                break;
 948
 949                if (i == ARRAY_SIZE(regulators)) {
 950                        dev_warn(&pdev->dev, "don't know how to configure regulator %s\n",
 951                                 reg_np->name);
 952                        continue;
 953                }
 954
 955                rdata->id = i;
 956                rdata->initdata = of_get_regulator_init_data(&pdev->dev,
 957                                                             reg_np);
 958                rdata->reg_node = reg_np;
 959                rdata++;
 960        }
 961        of_node_put(regulators_np);
 962
 963        if (of_get_property(pmic_np, "max8997,pmic-buck1-uses-gpio-dvs", NULL))
 964                pdata->buck1_gpiodvs = true;
 965
 966        if (of_get_property(pmic_np, "max8997,pmic-buck2-uses-gpio-dvs", NULL))
 967                pdata->buck2_gpiodvs = true;
 968
 969        if (of_get_property(pmic_np, "max8997,pmic-buck5-uses-gpio-dvs", NULL))
 970                pdata->buck5_gpiodvs = true;
 971
 972        if (pdata->buck1_gpiodvs || pdata->buck2_gpiodvs ||
 973                                                pdata->buck5_gpiodvs) {
 974                ret = max8997_pmic_dt_parse_dvs_gpio(pdev, pdata, pmic_np);
 975                if (ret)
 976                        return -EINVAL;
 977
 978                if (of_property_read_u32(pmic_np,
 979                                "max8997,pmic-buck125-default-dvs-idx",
 980                                &pdata->buck125_default_idx)) {
 981                        pdata->buck125_default_idx = 0;
 982                } else {
 983                        if (pdata->buck125_default_idx >= 8) {
 984                                pdata->buck125_default_idx = 0;
 985                                dev_info(&pdev->dev, "invalid value for default dvs index, using 0 instead\n");
 986                        }
 987                }
 988
 989                if (of_get_property(pmic_np,
 990                        "max8997,pmic-ignore-gpiodvs-side-effect", NULL))
 991                        pdata->ignore_gpiodvs_side_effect = true;
 992
 993                dvs_voltage_nr = 8;
 994        }
 995
 996        if (of_property_read_u32_array(pmic_np,
 997                                "max8997,pmic-buck1-dvs-voltage",
 998                                pdata->buck1_voltage, dvs_voltage_nr)) {
 999                dev_err(&pdev->dev, "buck1 voltages not specified\n");
1000                return -EINVAL;
1001        }
1002
1003        if (of_property_read_u32_array(pmic_np,
1004                                "max8997,pmic-buck2-dvs-voltage",
1005                                pdata->buck2_voltage, dvs_voltage_nr)) {
1006                dev_err(&pdev->dev, "buck2 voltages not specified\n");
1007                return -EINVAL;
1008        }
1009
1010        if (of_property_read_u32_array(pmic_np,
1011                                "max8997,pmic-buck5-dvs-voltage",
1012                                pdata->buck5_voltage, dvs_voltage_nr)) {
1013                dev_err(&pdev->dev, "buck5 voltages not specified\n");
1014                return -EINVAL;
1015        }
1016
1017        return 0;
1018}
1019#else
1020static int max8997_pmic_dt_parse_pdata(struct platform_device *pdev,
1021                                        struct max8997_platform_data *pdata)
1022{
1023        return 0;
1024}
1025#endif /* CONFIG_OF */
1026
1027static int max8997_pmic_probe(struct platform_device *pdev)
1028{
1029        struct max8997_dev *iodev = dev_get_drvdata(pdev->dev.parent);
1030        struct max8997_platform_data *pdata = iodev->pdata;
1031        struct regulator_config config = { };
1032        struct regulator_dev **rdev;
1033        struct max8997_data *max8997;
1034        struct i2c_client *i2c;
1035        int i, ret, size, nr_dvs;
1036        u8 max_buck1 = 0, max_buck2 = 0, max_buck5 = 0;
1037
1038        if (IS_ERR_OR_NULL(pdata)) {
1039                dev_err(pdev->dev.parent, "No platform init data supplied.\n");
1040                return -ENODEV;
1041        }
1042
1043        if (iodev->dev->of_node) {
1044                ret = max8997_pmic_dt_parse_pdata(pdev, pdata);
1045                if (ret)
1046                        return ret;
1047        }
1048
1049        max8997 = devm_kzalloc(&pdev->dev, sizeof(struct max8997_data),
1050                               GFP_KERNEL);
1051        if (!max8997)
1052                return -ENOMEM;
1053
1054        size = sizeof(struct regulator_dev *) * pdata->num_regulators;
1055        max8997->rdev = devm_kzalloc(&pdev->dev, size, GFP_KERNEL);
1056        if (!max8997->rdev)
1057                return -ENOMEM;
1058
1059        rdev = max8997->rdev;
1060        max8997->dev = &pdev->dev;
1061        max8997->iodev = iodev;
1062        max8997->num_regulators = pdata->num_regulators;
1063        platform_set_drvdata(pdev, max8997);
1064        i2c = max8997->iodev->i2c;
1065
1066        max8997->buck125_gpioindex = pdata->buck125_default_idx;
1067        max8997->buck1_gpiodvs = pdata->buck1_gpiodvs;
1068        max8997->buck2_gpiodvs = pdata->buck2_gpiodvs;
1069        max8997->buck5_gpiodvs = pdata->buck5_gpiodvs;
1070        memcpy(max8997->buck125_gpios, pdata->buck125_gpios, sizeof(int) * 3);
1071        max8997->ignore_gpiodvs_side_effect = pdata->ignore_gpiodvs_side_effect;
1072
1073        nr_dvs = (pdata->buck1_gpiodvs || pdata->buck2_gpiodvs ||
1074                        pdata->buck5_gpiodvs) ? 8 : 1;
1075
1076        for (i = 0; i < nr_dvs; i++) {
1077                max8997->buck1_vol[i] = ret =
1078                        max8997_get_voltage_proper_val(
1079                                        &buck1245_voltage_map_desc,
1080                                        pdata->buck1_voltage[i],
1081                                        pdata->buck1_voltage[i] +
1082                                        buck1245_voltage_map_desc.step);
1083                if (ret < 0)
1084                        goto err_out;
1085
1086                max8997->buck2_vol[i] = ret =
1087                        max8997_get_voltage_proper_val(
1088                                        &buck1245_voltage_map_desc,
1089                                        pdata->buck2_voltage[i],
1090                                        pdata->buck2_voltage[i] +
1091                                        buck1245_voltage_map_desc.step);
1092                if (ret < 0)
1093                        goto err_out;
1094
1095                max8997->buck5_vol[i] = ret =
1096                        max8997_get_voltage_proper_val(
1097                                        &buck1245_voltage_map_desc,
1098                                        pdata->buck5_voltage[i],
1099                                        pdata->buck5_voltage[i] +
1100                                        buck1245_voltage_map_desc.step);
1101                if (ret < 0)
1102                        goto err_out;
1103
1104                if (max_buck1 < max8997->buck1_vol[i])
1105                        max_buck1 = max8997->buck1_vol[i];
1106                if (max_buck2 < max8997->buck2_vol[i])
1107                        max_buck2 = max8997->buck2_vol[i];
1108                if (max_buck5 < max8997->buck5_vol[i])
1109                        max_buck5 = max8997->buck5_vol[i];
1110        }
1111
1112        /* For the safety, set max voltage before setting up */
1113        for (i = 0; i < 8; i++) {
1114                max8997_update_reg(i2c, MAX8997_REG_BUCK1DVS1 + i,
1115                                max_buck1, 0x3f);
1116                max8997_update_reg(i2c, MAX8997_REG_BUCK2DVS1 + i,
1117                                max_buck2, 0x3f);
1118                max8997_update_reg(i2c, MAX8997_REG_BUCK5DVS1 + i,
1119                                max_buck5, 0x3f);
1120        }
1121
1122        /* Initialize all the DVS related BUCK registers */
1123        for (i = 0; i < nr_dvs; i++) {
1124                max8997_update_reg(i2c, MAX8997_REG_BUCK1DVS1 + i,
1125                                max8997->buck1_vol[i],
1126                                0x3f);
1127                max8997_update_reg(i2c, MAX8997_REG_BUCK2DVS1 + i,
1128                                max8997->buck2_vol[i],
1129                                0x3f);
1130                max8997_update_reg(i2c, MAX8997_REG_BUCK5DVS1 + i,
1131                                max8997->buck5_vol[i],
1132                                0x3f);
1133        }
1134
1135        /*
1136         * If buck 1, 2, and 5 do not care DVS GPIO settings, ignore them.
1137         * If at least one of them cares, set gpios.
1138         */
1139        if (pdata->buck1_gpiodvs || pdata->buck2_gpiodvs ||
1140                        pdata->buck5_gpiodvs) {
1141
1142                if (!gpio_is_valid(pdata->buck125_gpios[0]) ||
1143                                !gpio_is_valid(pdata->buck125_gpios[1]) ||
1144                                !gpio_is_valid(pdata->buck125_gpios[2])) {
1145                        dev_err(&pdev->dev, "GPIO NOT VALID\n");
1146                        ret = -EINVAL;
1147                        goto err_out;
1148                }
1149
1150                ret = devm_gpio_request(&pdev->dev, pdata->buck125_gpios[0],
1151                                        "MAX8997 SET1");
1152                if (ret)
1153                        goto err_out;
1154
1155                ret = devm_gpio_request(&pdev->dev, pdata->buck125_gpios[1],
1156                                        "MAX8997 SET2");
1157                if (ret)
1158                        goto err_out;
1159
1160                ret = devm_gpio_request(&pdev->dev, pdata->buck125_gpios[2],
1161                                "MAX8997 SET3");
1162                if (ret)
1163                        goto err_out;
1164
1165                gpio_direction_output(pdata->buck125_gpios[0],
1166                                (max8997->buck125_gpioindex >> 2)
1167                                & 0x1); /* SET1 */
1168                gpio_direction_output(pdata->buck125_gpios[1],
1169                                (max8997->buck125_gpioindex >> 1)
1170                                & 0x1); /* SET2 */
1171                gpio_direction_output(pdata->buck125_gpios[2],
1172                                (max8997->buck125_gpioindex >> 0)
1173                                & 0x1); /* SET3 */
1174        }
1175
1176        /* DVS-GPIO disabled */
1177        max8997_update_reg(i2c, MAX8997_REG_BUCK1CTRL, (pdata->buck1_gpiodvs) ?
1178                        (1 << 1) : (0 << 1), 1 << 1);
1179        max8997_update_reg(i2c, MAX8997_REG_BUCK2CTRL, (pdata->buck2_gpiodvs) ?
1180                        (1 << 1) : (0 << 1), 1 << 1);
1181        max8997_update_reg(i2c, MAX8997_REG_BUCK5CTRL, (pdata->buck5_gpiodvs) ?
1182                        (1 << 1) : (0 << 1), 1 << 1);
1183
1184        /* Misc Settings */
1185        max8997->ramp_delay = 10; /* set 10mV/us, which is the default */
1186        max8997_write_reg(i2c, MAX8997_REG_BUCKRAMP, (0xf << 4) | 0x9);
1187
1188        for (i = 0; i < pdata->num_regulators; i++) {
1189                const struct voltage_map_desc *desc;
1190                int id = pdata->regulators[i].id;
1191
1192                desc = reg_voltage_map[id];
1193                if (desc) {
1194                        regulators[id].n_voltages =
1195                                (desc->max - desc->min) / desc->step + 1;
1196                } else if (id == MAX8997_ESAFEOUT1 || id == MAX8997_ESAFEOUT2) {
1197                        regulators[id].volt_table = safeoutvolt;
1198                        regulators[id].n_voltages = ARRAY_SIZE(safeoutvolt);
1199                } else if (id == MAX8997_CHARGER_CV) {
1200                        regulators[id].n_voltages = 16;
1201                }
1202
1203                config.dev = max8997->dev;
1204                config.init_data = pdata->regulators[i].initdata;
1205                config.driver_data = max8997;
1206                config.of_node = pdata->regulators[i].reg_node;
1207
1208                rdev[i] = regulator_register(&regulators[id], &config);
1209                if (IS_ERR(rdev[i])) {
1210                        ret = PTR_ERR(rdev[i]);
1211                        dev_err(max8997->dev, "regulator init failed for %d\n",
1212                                        id);
1213                        rdev[i] = NULL;
1214                        goto err;
1215                }
1216        }
1217
1218        return 0;
1219err:
1220        while (--i >= 0)
1221                regulator_unregister(rdev[i]);
1222err_out:
1223        return ret;
1224}
1225
1226static int max8997_pmic_remove(struct platform_device *pdev)
1227{
1228        struct max8997_data *max8997 = platform_get_drvdata(pdev);
1229        struct regulator_dev **rdev = max8997->rdev;
1230        int i;
1231
1232        for (i = 0; i < max8997->num_regulators; i++)
1233                regulator_unregister(rdev[i]);
1234        return 0;
1235}
1236
1237static const struct platform_device_id max8997_pmic_id[] = {
1238        { "max8997-pmic", 0},
1239        { },
1240};
1241MODULE_DEVICE_TABLE(platform, max8997_pmic_id);
1242
1243static struct platform_driver max8997_pmic_driver = {
1244        .driver = {
1245                .name = "max8997-pmic",
1246                .owner = THIS_MODULE,
1247        },
1248        .probe = max8997_pmic_probe,
1249        .remove = max8997_pmic_remove,
1250        .id_table = max8997_pmic_id,
1251};
1252
1253static int __init max8997_pmic_init(void)
1254{
1255        return platform_driver_register(&max8997_pmic_driver);
1256}
1257subsys_initcall(max8997_pmic_init);
1258
1259static void __exit max8997_pmic_cleanup(void)
1260{
1261        platform_driver_unregister(&max8997_pmic_driver);
1262}
1263module_exit(max8997_pmic_cleanup);
1264
1265MODULE_DESCRIPTION("MAXIM 8997/8966 Regulator Driver");
1266MODULE_AUTHOR("MyungJoo Ham <myungjoo.ham@samsung.com>");
1267MODULE_LICENSE("GPL");
1268
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.