drivers/regulator/palmas-regulator.c

   1 /*
   2  * Driver for Regulator part of Palmas PMIC Chips
   3  *
   4  * Copyright 2011-2013 Texas Instruments Inc.
   5  *
   6  * Author: Graeme Gregory <gg@slimlogic.co.uk>
   7  * Author: Ian Lartey <ian@slimlogic.co.uk>
   8  *
   9  *  This program is free software; you can redistribute it and/or modify it
  10  *  under  the terms of the GNU General  Public License as published by the
  11  *  Free Software Foundation;  either version 2 of the License, or (at your
  12  *  option) any later version.
  13  *
  14  */
  15
  16 #include <linux/kernel.h>
  17 #include <linux/module.h>
  18 #include <linux/init.h>
  19 #include <linux/err.h>
  20 #include <linux/platform_device.h>
  21 #include <linux/regulator/driver.h>
  22 #include <linux/regulator/machine.h>
  23 #include <linux/slab.h>
  24 #include <linux/regmap.h>
  25 #include <linux/mfd/palmas.h>
  26 #include <linux/of.h>
  27 #include <linux/of_platform.h>
  28 #include <linux/regulator/of_regulator.h>
  29
  30 struct regs_info {
  31         char    *name;
  32         char    *sname;
  33         u8      vsel_addr;
  34         u8      ctrl_addr;
  35         u8      tstep_addr;
  36 };
  37
  38 static const struct regs_info palmas_regs_info[] = {
  39         {
  40                 .name           = "SMPS12",
  41                 .sname          = "smps1-in",
  42                 .vsel_addr      = PALMAS_SMPS12_VOLTAGE,
  43                 .ctrl_addr      = PALMAS_SMPS12_CTRL,
  44                 .tstep_addr     = PALMAS_SMPS12_TSTEP,
  45         },
  46         {
  47                 .name           = "SMPS123",
  48                 .sname          = "smps1-in",
  49                 .vsel_addr      = PALMAS_SMPS12_VOLTAGE,
  50                 .ctrl_addr      = PALMAS_SMPS12_CTRL,
  51                 .tstep_addr     = PALMAS_SMPS12_TSTEP,
  52         },
  53         {
  54                 .name           = "SMPS3",
  55                 .sname          = "smps3-in",
  56                 .vsel_addr      = PALMAS_SMPS3_VOLTAGE,
  57                 .ctrl_addr      = PALMAS_SMPS3_CTRL,
  58         },
  59         {
  60                 .name           = "SMPS45",
  61                 .sname          = "smps4-in",
  62                 .vsel_addr      = PALMAS_SMPS45_VOLTAGE,
  63                 .ctrl_addr      = PALMAS_SMPS45_CTRL,
  64                 .tstep_addr     = PALMAS_SMPS45_TSTEP,
  65         },
  66         {
  67                 .name           = "SMPS457",
  68                 .sname          = "smps4-in",
  69                 .vsel_addr      = PALMAS_SMPS45_VOLTAGE,
  70                 .ctrl_addr      = PALMAS_SMPS45_CTRL,
  71                 .tstep_addr     = PALMAS_SMPS45_TSTEP,
  72         },
  73         {
  74                 .name           = "SMPS6",
  75                 .sname          = "smps6-in",
  76                 .vsel_addr      = PALMAS_SMPS6_VOLTAGE,
  77                 .ctrl_addr      = PALMAS_SMPS6_CTRL,
  78                 .tstep_addr     = PALMAS_SMPS6_TSTEP,
  79         },
  80         {
  81                 .name           = "SMPS7",
  82                 .sname          = "smps7-in",
  83                 .vsel_addr      = PALMAS_SMPS7_VOLTAGE,
  84                 .ctrl_addr      = PALMAS_SMPS7_CTRL,
  85         },
  86         {
  87                 .name           = "SMPS8",
  88                 .sname          = "smps8-in",
  89                 .vsel_addr      = PALMAS_SMPS8_VOLTAGE,
  90                 .ctrl_addr      = PALMAS_SMPS8_CTRL,
  91                 .tstep_addr     = PALMAS_SMPS8_TSTEP,
  92         },
  93         {
  94                 .name           = "SMPS9",
  95                 .sname          = "smps9-in",
  96                 .vsel_addr      = PALMAS_SMPS9_VOLTAGE,
  97                 .ctrl_addr      = PALMAS_SMPS9_CTRL,
  98         },
  99         {
 100                 .name           = "SMPS10_OUT2",
 101                 .sname          = "smps10-in",
 102                 .ctrl_addr      = PALMAS_SMPS10_CTRL,
 103         },
 104         {
 105                 .name           = "SMPS10_OUT1",
 106                 .sname          = "smps10-out2",
 107                 .ctrl_addr      = PALMAS_SMPS10_CTRL,
 108         },
 109         {
 110                 .name           = "LDO1",
 111                 .sname          = "ldo1-in",
 112                 .vsel_addr      = PALMAS_LDO1_VOLTAGE,
 113                 .ctrl_addr      = PALMAS_LDO1_CTRL,
 114         },
 115         {
 116                 .name           = "LDO2",
 117                 .sname          = "ldo2-in",
 118                 .vsel_addr      = PALMAS_LDO2_VOLTAGE,
 119                 .ctrl_addr      = PALMAS_LDO2_CTRL,
 120         },
 121         {
 122                 .name           = "LDO3",
 123                 .sname          = "ldo3-in",
 124                 .vsel_addr      = PALMAS_LDO3_VOLTAGE,
 125                 .ctrl_addr      = PALMAS_LDO3_CTRL,
 126         },
 127         {
 128                 .name           = "LDO4",
 129                 .sname          = "ldo4-in",
 130                 .vsel_addr      = PALMAS_LDO4_VOLTAGE,
 131                 .ctrl_addr      = PALMAS_LDO4_CTRL,
 132         },
 133         {
 134                 .name           = "LDO5",
 135                 .sname          = "ldo5-in",
 136                 .vsel_addr      = PALMAS_LDO5_VOLTAGE,
 137                 .ctrl_addr      = PALMAS_LDO5_CTRL,
 138         },
 139         {
 140                 .name           = "LDO6",
 141                 .sname          = "ldo6-in",
 142                 .vsel_addr      = PALMAS_LDO6_VOLTAGE,
 143                 .ctrl_addr      = PALMAS_LDO6_CTRL,
 144         },
 145         {
 146                 .name           = "LDO7",
 147                 .sname          = "ldo7-in",
 148                 .vsel_addr      = PALMAS_LDO7_VOLTAGE,
 149                 .ctrl_addr      = PALMAS_LDO7_CTRL,
 150         },
 151         {
 152                 .name           = "LDO8",
 153                 .sname          = "ldo8-in",
 154                 .vsel_addr      = PALMAS_LDO8_VOLTAGE,
 155                 .ctrl_addr      = PALMAS_LDO8_CTRL,
 156         },
 157         {
 158                 .name           = "LDO9",
 159                 .sname          = "ldo9-in",
 160                 .vsel_addr      = PALMAS_LDO9_VOLTAGE,
 161                 .ctrl_addr      = PALMAS_LDO9_CTRL,
 162         },
 163         {
 164                 .name           = "LDOLN",
 165                 .sname          = "ldoln-in",
 166                 .vsel_addr      = PALMAS_LDOLN_VOLTAGE,
 167                 .ctrl_addr      = PALMAS_LDOLN_CTRL,
 168         },
 169         {
 170                 .name           = "LDOUSB",
 171                 .sname          = "ldousb-in",
 172                 .vsel_addr      = PALMAS_LDOUSB_VOLTAGE,
 173                 .ctrl_addr      = PALMAS_LDOUSB_CTRL,
 174         },
 175         {
 176                 .name           = "REGEN1",
 177                 .ctrl_addr      = PALMAS_REGEN1_CTRL,
 178         },
 179         {
 180                 .name           = "REGEN2",
 181                 .ctrl_addr      = PALMAS_REGEN2_CTRL,
 182         },
 183         {
 184                 .name           = "REGEN3",
 185                 .ctrl_addr      = PALMAS_REGEN3_CTRL,
 186         },
 187         {
 188                 .name           = "SYSEN1",
 189                 .ctrl_addr      = PALMAS_SYSEN1_CTRL,
 190         },
 191         {
 192                 .name           = "SYSEN2",
 193                 .ctrl_addr      = PALMAS_SYSEN2_CTRL,
 194         },
 195 };
 196
 197 static unsigned int palmas_smps_ramp_delay[4] = {0, 10000, 5000, 2500};
 198
 199 #define SMPS_CTRL_MODE_OFF              0x00
 200 #define SMPS_CTRL_MODE_ON               0x01
 201 #define SMPS_CTRL_MODE_ECO              0x02
 202 #define SMPS_CTRL_MODE_PWM              0x03
 203
 204 #define PALMAS_SMPS_NUM_VOLTAGES        122
 205 #define PALMAS_SMPS10_NUM_VOLTAGES      2
 206 #define PALMAS_LDO_NUM_VOLTAGES         50
 207
 208 #define SMPS10_VSEL                     (1<<3)
 209 #define SMPS10_BOOST_EN                 (1<<2)
 210 #define SMPS10_BYPASS_EN                (1<<1)
 211 #define SMPS10_SWITCH_EN                (1<<0)
 212
 213 #define REGULATOR_SLAVE                 0
 214
 215 static int palmas_smps_read(struct palmas *palmas, unsigned int reg,
 216                 unsigned int *dest)
 217 {
 218         unsigned int addr;
 219
 220         addr = PALMAS_BASE_TO_REG(PALMAS_SMPS_BASE, reg);
 221
 222         return regmap_read(palmas->regmap[REGULATOR_SLAVE], addr, dest);
 223 }
 224
 225 static int palmas_smps_write(struct palmas *palmas, unsigned int reg,
 226                 unsigned int value)
 227 {
 228         unsigned int addr;
 229
 230         addr = PALMAS_BASE_TO_REG(PALMAS_SMPS_BASE, reg);
 231
 232         return regmap_write(palmas->regmap[REGULATOR_SLAVE], addr, value);
 233 }
 234
 235 static int palmas_ldo_read(struct palmas *palmas, unsigned int reg,
 236                 unsigned int *dest)
 237 {
 238         unsigned int addr;
 239
 240         addr = PALMAS_BASE_TO_REG(PALMAS_LDO_BASE, reg);
 241
 242         return regmap_read(palmas->regmap[REGULATOR_SLAVE], addr, dest);
 243 }
 244
 245 static int palmas_ldo_write(struct palmas *palmas, unsigned int reg,
 246                 unsigned int value)
 247 {
 248         unsigned int addr;
 249
 250         addr = PALMAS_BASE_TO_REG(PALMAS_LDO_BASE, reg);
 251
 252         return regmap_write(palmas->regmap[REGULATOR_SLAVE], addr, value);
 253 }
 254
 255 static int palmas_is_enabled_smps(struct regulator_dev *dev)
 256 {
 257         struct palmas_pmic *pmic = rdev_get_drvdata(dev);
 258         int id = rdev_get_id(dev);
 259         unsigned int reg;
 260
 261         palmas_smps_read(pmic->palmas, palmas_regs_info[id].ctrl_addr, &reg);
 262
 263         reg &= PALMAS_SMPS12_CTRL_STATUS_MASK;
 264         reg >>= PALMAS_SMPS12_CTRL_STATUS_SHIFT;
 265
 266         return !!(reg);
 267 }
 268
 269 static int palmas_enable_smps(struct regulator_dev *dev)
 270 {
 271         struct palmas_pmic *pmic = rdev_get_drvdata(dev);
 272         int id = rdev_get_id(dev);
 273         unsigned int reg;
 274
 275         palmas_smps_read(pmic->palmas, palmas_regs_info[id].ctrl_addr, &reg);
 276
 277         reg &= ~PALMAS_SMPS12_CTRL_MODE_ACTIVE_MASK;
 278         if (pmic->current_reg_mode[id])
 279                 reg |= pmic->current_reg_mode[id];
 280         else
 281                 reg |= SMPS_CTRL_MODE_ON;
 282
 283         palmas_smps_write(pmic->palmas, palmas_regs_info[id].ctrl_addr, reg);
 284
 285         return 0;
 286 }
 287
 288 static int palmas_disable_smps(struct regulator_dev *dev)
 289 {
 290         struct palmas_pmic *pmic = rdev_get_drvdata(dev);
 291         int id = rdev_get_id(dev);
 292         unsigned int reg;
 293
 294         palmas_smps_read(pmic->palmas, palmas_regs_info[id].ctrl_addr, &reg);
 295
 296         reg &= ~PALMAS_SMPS12_CTRL_MODE_ACTIVE_MASK;
 297
 298         palmas_smps_write(pmic->palmas, palmas_regs_info[id].ctrl_addr, reg);
 299
 300         return 0;
 301 }
 302
 303 static int palmas_set_mode_smps(struct regulator_dev *dev, unsigned int mode)
 304 {
 305         struct palmas_pmic *pmic = rdev_get_drvdata(dev);
 306         int id = rdev_get_id(dev);
 307         unsigned int reg;
 308         bool rail_enable = true;
 309
 310         palmas_smps_read(pmic->palmas, palmas_regs_info[id].ctrl_addr, &reg);
 311         reg &= ~PALMAS_SMPS12_CTRL_MODE_ACTIVE_MASK;
 312
 313         if (reg == SMPS_CTRL_MODE_OFF)
 314                 rail_enable = false;
 315
 316         switch (mode) {
 317         case REGULATOR_MODE_NORMAL:
 318                 reg |= SMPS_CTRL_MODE_ON;
 319                 break;
 320         case REGULATOR_MODE_IDLE:
 321                 reg |= SMPS_CTRL_MODE_ECO;
 322                 break;
 323         case REGULATOR_MODE_FAST:
 324                 reg |= SMPS_CTRL_MODE_PWM;
 325                 break;
 326         default:
 327                 return -EINVAL;
 328         }
 329
 330         pmic->current_reg_mode[id] = reg & PALMAS_SMPS12_CTRL_MODE_ACTIVE_MASK;
 331         if (rail_enable)
 332                 palmas_smps_write(pmic->palmas,
 333                         palmas_regs_info[id].ctrl_addr, reg);
 334         return 0;
 335 }
 336
 337 static unsigned int palmas_get_mode_smps(struct regulator_dev *dev)
 338 {
 339         struct palmas_pmic *pmic = rdev_get_drvdata(dev);
 340         int id = rdev_get_id(dev);
 341         unsigned int reg;
 342
 343         reg = pmic->current_reg_mode[id] & PALMAS_SMPS12_CTRL_MODE_ACTIVE_MASK;
 344
 345         switch (reg) {
 346         case SMPS_CTRL_MODE_ON:
 347                 return REGULATOR_MODE_NORMAL;
 348         case SMPS_CTRL_MODE_ECO:
 349                 return REGULATOR_MODE_IDLE;
 350         case SMPS_CTRL_MODE_PWM:
 351                 return REGULATOR_MODE_FAST;
 352         }
 353
 354         return 0;
 355 }
 356
 357 static int palmas_list_voltage_smps(struct regulator_dev *dev,
 358                                         unsigned selector)
 359 {
 360         struct palmas_pmic *pmic = rdev_get_drvdata(dev);
 361         int id = rdev_get_id(dev);
 362         int mult = 1;
 363
 364         /* Read the multiplier set in VSEL register to return
 365          * the correct voltage.
 366          */
 367         if (pmic->range[id])
 368                 mult = 2;
 369
 370         if (selector == 0)
 371                 return 0;
 372         else if (selector < 6)
 373                 return 500000 * mult;
 374         else
 375                 /* Voltage is linear mapping starting from selector 6,
 376                  * volt = (0.49V + ((selector - 5) * 0.01V)) * RANGE
 377                  * RANGE is either x1 or x2
 378                  */
 379                 return (490000 + ((selector - 5) * 10000)) * mult;
 380 }
 381
 382 static int palmas_map_voltage_smps(struct regulator_dev *rdev,
 383                 int min_uV, int max_uV)
 384 {
 385         struct palmas_pmic *pmic = rdev_get_drvdata(rdev);
 386         int id = rdev_get_id(rdev);
 387         int ret, voltage;
 388
 389         if (min_uV == 0)
 390                 return 0;
 391
 392         if (pmic->range[id]) { /* RANGE is x2 */
 393                 if (min_uV < 1000000)
 394                         min_uV = 1000000;
 395                 ret = DIV_ROUND_UP(min_uV - 1000000, 20000) + 6;
 396         } else {                /* RANGE is x1 */
 397                 if (min_uV < 500000)
 398                         min_uV = 500000;
 399                 ret = DIV_ROUND_UP(min_uV - 500000, 10000) + 6;
 400         }
 401
 402         /* Map back into a voltage to verify we're still in bounds */
 403         voltage = palmas_list_voltage_smps(rdev, ret);
 404         if (voltage < min_uV || voltage > max_uV)
 405                 return -EINVAL;
 406
 407         return ret;
 408 }
 409
 410 static int palma_smps_set_voltage_smps_time_sel(struct regulator_dev *rdev,
 411         unsigned int old_selector, unsigned int new_selector)
 412 {
 413         struct palmas_pmic *pmic = rdev_get_drvdata(rdev);
 414         int id = rdev_get_id(rdev);
 415         int old_uv, new_uv;
 416         unsigned int ramp_delay = pmic->ramp_delay[id];
 417
 418         if (!ramp_delay)
 419                 return 0;
 420
 421         old_uv = palmas_list_voltage_smps(rdev, old_selector);
 422         if (old_uv < 0)
 423                 return old_uv;
 424
 425         new_uv = palmas_list_voltage_smps(rdev, new_selector);
 426         if (new_uv < 0)
 427                 return new_uv;
 428
 429         return DIV_ROUND_UP(abs(old_uv - new_uv), ramp_delay);
 430 }
 431
 432 static int palmas_smps_set_ramp_delay(struct regulator_dev *rdev,
 433                  int ramp_delay)
 434 {
 435         struct palmas_pmic *pmic = rdev_get_drvdata(rdev);
 436         int id = rdev_get_id(rdev);
 437         unsigned int reg = 0;
 438         unsigned int addr = palmas_regs_info[id].tstep_addr;
 439         int ret;
 440
 441         /* SMPS3 and SMPS7 do not have tstep_addr setting */
 442         switch (id) {
 443         case PALMAS_REG_SMPS3:
 444         case PALMAS_REG_SMPS7:
 445                 return 0;
 446         }
 447
 448         if (ramp_delay <= 0)
 449                 reg = 0;
 450         else if (ramp_delay <= 2500)
 451                 reg = 3;
 452         else if (ramp_delay <= 5000)
 453                 reg = 2;
 454         else
 455                 reg = 1;
 456
 457         ret = palmas_smps_write(pmic->palmas, addr, reg);
 458         if (ret < 0) {
 459                 dev_err(pmic->palmas->dev, "TSTEP write failed: %d\n", ret);
 460                 return ret;
 461         }
 462
 463         pmic->ramp_delay[id] = palmas_smps_ramp_delay[reg];
 464         return ret;
 465 }
 466
 467 static struct regulator_ops palmas_ops_smps = {
 468         .is_enabled             = palmas_is_enabled_smps,
 469         .enable                 = palmas_enable_smps,
 470         .disable                = palmas_disable_smps,
 471         .set_mode               = palmas_set_mode_smps,
 472         .get_mode               = palmas_get_mode_smps,
 473         .get_voltage_sel        = regulator_get_voltage_sel_regmap,
 474         .set_voltage_sel        = regulator_set_voltage_sel_regmap,
 475         .list_voltage           = palmas_list_voltage_smps,
 476         .map_voltage            = palmas_map_voltage_smps,
 477         .set_voltage_time_sel   = palma_smps_set_voltage_smps_time_sel,
 478         .set_ramp_delay         = palmas_smps_set_ramp_delay,
 479 };
 480
 481 static struct regulator_ops palmas_ops_smps10 = {
 482         .is_enabled             = regulator_is_enabled_regmap,
 483         .enable                 = regulator_enable_regmap,
 484         .disable                = regulator_disable_regmap,
 485         .get_voltage_sel        = regulator_get_voltage_sel_regmap,
 486         .set_voltage_sel        = regulator_set_voltage_sel_regmap,
 487         .list_voltage           = regulator_list_voltage_linear,
 488         .map_voltage            = regulator_map_voltage_linear,
 489         .set_bypass             = regulator_set_bypass_regmap,
 490         .get_bypass             = regulator_get_bypass_regmap,
 491 };
 492
 493 static int palmas_is_enabled_ldo(struct regulator_dev *dev)
 494 {
 495         struct palmas_pmic *pmic = rdev_get_drvdata(dev);
 496         int id = rdev_get_id(dev);
 497         unsigned int reg;
 498
 499         palmas_ldo_read(pmic->palmas, palmas_regs_info[id].ctrl_addr, &reg);
 500
 501         reg &= PALMAS_LDO1_CTRL_STATUS;
 502
 503         return !!(reg);
 504 }
 505
 506 static struct regulator_ops palmas_ops_ldo = {
 507         .is_enabled             = palmas_is_enabled_ldo,
 508         .enable                 = regulator_enable_regmap,
 509         .disable                = regulator_disable_regmap,
 510         .get_voltage_sel        = regulator_get_voltage_sel_regmap,
 511         .set_voltage_sel        = regulator_set_voltage_sel_regmap,
 512         .list_voltage           = regulator_list_voltage_linear,
 513         .map_voltage            = regulator_map_voltage_linear,
 514 };
 515
 516 static struct regulator_ops palmas_ops_extreg = {
 517         .is_enabled             = regulator_is_enabled_regmap,
 518         .enable                 = regulator_enable_regmap,
 519         .disable                = regulator_disable_regmap,
 520 };
 521
 522 /*
 523  * setup the hardware based sleep configuration of the SMPS/LDO regulators
 524  * from the platform data. This is different to the software based control
 525  * supported by the regulator framework as it is controlled by toggling
 526  * pins on the PMIC such as PREQ, SYSEN, ...
 527  */
 528 static int palmas_smps_init(struct palmas *palmas, int id,
 529                 struct palmas_reg_init *reg_init)
 530 {
 531         unsigned int reg;
 532         unsigned int addr;
 533         int ret;
 534
 535         addr = palmas_regs_info[id].ctrl_addr;
 536
 537         ret = palmas_smps_read(palmas, addr, &reg);
 538         if (ret)
 539                 return ret;
 540
 541         switch (id) {
 542         case PALMAS_REG_SMPS10_OUT1:
 543         case PALMAS_REG_SMPS10_OUT2:
 544                 reg &= ~PALMAS_SMPS10_CTRL_MODE_SLEEP_MASK;
 545                 if (reg_init->mode_sleep)
 546                         reg |= reg_init->mode_sleep <<
 547                                         PALMAS_SMPS10_CTRL_MODE_SLEEP_SHIFT;
 548                 break;
 549         default:
 550                 if (reg_init->warm_reset)
 551                         reg |= PALMAS_SMPS12_CTRL_WR_S;
 552                 else
 553                         reg &= ~PALMAS_SMPS12_CTRL_WR_S;
 554
 555                 if (reg_init->roof_floor)
 556                         reg |= PALMAS_SMPS12_CTRL_ROOF_FLOOR_EN;
 557                 else
 558                         reg &= ~PALMAS_SMPS12_CTRL_ROOF_FLOOR_EN;
 559
 560                 reg &= ~PALMAS_SMPS12_CTRL_MODE_SLEEP_MASK;
 561                 if (reg_init->mode_sleep)
 562                         reg |= reg_init->mode_sleep <<
 563                                         PALMAS_SMPS12_CTRL_MODE_SLEEP_SHIFT;
 564         }
 565
 566         ret = palmas_smps_write(palmas, addr, reg);
 567         if (ret)
 568                 return ret;
 569
 570         if (palmas_regs_info[id].vsel_addr && reg_init->vsel) {
 571                 addr = palmas_regs_info[id].vsel_addr;
 572
 573                 reg = reg_init->vsel;
 574
 575                 ret = palmas_smps_write(palmas, addr, reg);
 576                 if (ret)
 577                         return ret;
 578         }
 579
 580
 581         return 0;
 582 }
 583
 584 static int palmas_ldo_init(struct palmas *palmas, int id,
 585                 struct palmas_reg_init *reg_init)
 586 {
 587         unsigned int reg;
 588         unsigned int addr;
 589         int ret;
 590
 591         addr = palmas_regs_info[id].ctrl_addr;
 592
 593         ret = palmas_ldo_read(palmas, addr, &reg);
 594         if (ret)
 595                 return ret;
 596
 597         if (reg_init->warm_reset)
 598                 reg |= PALMAS_LDO1_CTRL_WR_S;
 599         else
 600                 reg &= ~PALMAS_LDO1_CTRL_WR_S;
 601
 602         if (reg_init->mode_sleep)
 603                 reg |= PALMAS_LDO1_CTRL_MODE_SLEEP;
 604         else
 605                 reg &= ~PALMAS_LDO1_CTRL_MODE_SLEEP;
 606
 607         ret = palmas_ldo_write(palmas, addr, reg);
 608         if (ret)
 609                 return ret;
 610
 611         return 0;
 612 }
 613
 614 static int palmas_extreg_init(struct palmas *palmas, int id,
 615                 struct palmas_reg_init *reg_init)
 616 {
 617         unsigned int addr;
 618         int ret;
 619         unsigned int val = 0;
 620
 621         addr = palmas_regs_info[id].ctrl_addr;
 622
 623         if (reg_init->mode_sleep)
 624                 val = PALMAS_REGEN1_CTRL_MODE_SLEEP;
 625
 626         ret = palmas_update_bits(palmas, PALMAS_RESOURCE_BASE,
 627                         addr, PALMAS_REGEN1_CTRL_MODE_SLEEP, val);
 628         if (ret < 0) {
 629                 dev_err(palmas->dev, "Resource reg 0x%02x update failed %d\n",
 630                         addr, ret);
 631                 return ret;
 632         }
 633         return 0;
 634 }
 635
 636 static void palmas_enable_ldo8_track(struct palmas *palmas)
 637 {
 638         unsigned int reg;
 639         unsigned int addr;
 640         int ret;
 641
 642         addr = palmas_regs_info[PALMAS_REG_LDO8].ctrl_addr;
 643
 644         ret = palmas_ldo_read(palmas, addr, &reg);
 645         if (ret) {
 646                 dev_err(palmas->dev, "Error in reading ldo8 control reg\n");
 647                 return;
 648         }
 649
 650         reg |= PALMAS_LDO8_CTRL_LDO_TRACKING_EN;
 651         ret = palmas_ldo_write(palmas, addr, reg);
 652         if (ret < 0) {
 653                 dev_err(palmas->dev, "Error in enabling tracking mode\n");
 654                 return;
 655         }
 656         /*
 657          * When SMPS45 is set to off and LDO8 tracking is enabled, the LDO8
 658          * output is defined by the LDO8_VOLTAGE.VSEL register divided by two,
 659          * and can be set from 0.45 to 1.65 V.
 660          */
 661         addr = palmas_regs_info[PALMAS_REG_LDO8].vsel_addr;
 662         ret = palmas_ldo_read(palmas, addr, &reg);
 663         if (ret) {
 664                 dev_err(palmas->dev, "Error in reading ldo8 voltage reg\n");
 665                 return;
 666         }
 667
 668         reg = (reg << 1) & PALMAS_LDO8_VOLTAGE_VSEL_MASK;
 669         ret = palmas_ldo_write(palmas, addr, reg);
 670         if (ret < 0)
 671                 dev_err(palmas->dev, "Error in setting ldo8 voltage reg\n");
 672
 673         return;
 674 }
 675
 676 static struct of_regulator_match palmas_matches[] = {
 677         { .name = "smps12", },
 678         { .name = "smps123", },
 679         { .name = "smps3", },
 680         { .name = "smps45", },
 681         { .name = "smps457", },
 682         { .name = "smps6", },
 683         { .name = "smps7", },
 684         { .name = "smps8", },
 685         { .name = "smps9", },
 686         { .name = "smps10_out2", },
 687         { .name = "smps10_out1", },
 688         { .name = "ldo1", },
 689         { .name = "ldo2", },
 690         { .name = "ldo3", },
 691         { .name = "ldo4", },
 692         { .name = "ldo5", },
 693         { .name = "ldo6", },
 694         { .name = "ldo7", },
 695         { .name = "ldo8", },
 696         { .name = "ldo9", },
 697         { .name = "ldoln", },
 698         { .name = "ldousb", },
 699         { .name = "regen1", },
 700         { .name = "regen2", },
 701         { .name = "regen3", },
 702         { .name = "sysen1", },
 703         { .name = "sysen2", },
 704 };
 705
 706 static void palmas_dt_to_pdata(struct device *dev,
 707                 struct device_node *node,
 708                 struct palmas_pmic_platform_data *pdata)
 709 {
 710         struct device_node *regulators;
 711         u32 prop;
 712         int idx, ret;
 713
 714         node = of_node_get(node);
 715         regulators = of_find_node_by_name(node, "regulators");
 716         if (!regulators) {
 717                 dev_info(dev, "regulator node not found\n");
 718                 return;
 719         }
 720
 721         ret = of_regulator_match(dev, regulators, palmas_matches,
 722                         PALMAS_NUM_REGS);
 723         of_node_put(regulators);
 724         if (ret < 0) {
 725                 dev_err(dev, "Error parsing regulator init data: %d\n", ret);
 726                 return;
 727         }
 728
 729         for (idx = 0; idx < PALMAS_NUM_REGS; idx++) {
 730                 if (!palmas_matches[idx].init_data ||
 731                                 !palmas_matches[idx].of_node)
 732                         continue;
 733
 734                 pdata->reg_data[idx] = palmas_matches[idx].init_data;
 735
 736                 pdata->reg_init[idx] = devm_kzalloc(dev,
 737                                 sizeof(struct palmas_reg_init), GFP_KERNEL);
 738
 739                 pdata->reg_init[idx]->warm_reset =
 740                         of_property_read_bool(palmas_matches[idx].of_node,
 741                                              "ti,warm-reset");
 742
 743                 pdata->reg_init[idx]->roof_floor =
 744                         of_property_read_bool(palmas_matches[idx].of_node,
 745                                               "ti,roof-floor");
 746
 747                 ret = of_property_read_u32(palmas_matches[idx].of_node,
 748                                 "ti,mode-sleep", &prop);
 749                 if (!ret)
 750                         pdata->reg_init[idx]->mode_sleep = prop;
 751
 752                 ret = of_property_read_bool(palmas_matches[idx].of_node,
 753                                             "ti,smps-range");
 754                 if (ret)
 755                         pdata->reg_init[idx]->vsel =
 756                                 PALMAS_SMPS12_VOLTAGE_RANGE;
 757
 758                 if (idx == PALMAS_REG_LDO8)
 759                         pdata->enable_ldo8_tracking = of_property_read_bool(
 760                                                 palmas_matches[idx].of_node,
 761                                                 "ti,enable-ldo8-tracking");
 762         }
 763
 764         pdata->ldo6_vibrator = of_property_read_bool(node, "ti,ldo6-vibrator");
 765 }
 766
 767
 768 static int palmas_regulators_probe(struct platform_device *pdev)
 769 {
 770         struct palmas *palmas = dev_get_drvdata(pdev->dev.parent);
 771         struct palmas_pmic_platform_data *pdata = dev_get_platdata(&pdev->dev);
 772         struct device_node *node = pdev->dev.of_node;
 773         struct regulator_dev *rdev;
 774         struct regulator_config config = { };
 775         struct palmas_pmic *pmic;
 776         struct palmas_reg_init *reg_init;
 777         int id = 0, ret;
 778         unsigned int addr, reg;
 779
 780         if (node && !pdata) {
 781                 pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
 782
 783                 if (!pdata)
 784                         return -ENOMEM;
 785
 786                 palmas_dt_to_pdata(&pdev->dev, node, pdata);
 787         }
 788
 789         pmic = devm_kzalloc(&pdev->dev, sizeof(*pmic), GFP_KERNEL);
 790         if (!pmic)
 791                 return -ENOMEM;
 792
 793         pmic->dev = &pdev->dev;
 794         pmic->palmas = palmas;
 795         palmas->pmic = pmic;
 796         platform_set_drvdata(pdev, pmic);
 797
 798         ret = palmas_smps_read(palmas, PALMAS_SMPS_CTRL, &reg);
 799         if (ret)
 800                 return ret;
 801
 802         if (reg & PALMAS_SMPS_CTRL_SMPS12_SMPS123_EN)
 803                 pmic->smps123 = 1;
 804
 805         if (reg & PALMAS_SMPS_CTRL_SMPS45_SMPS457_EN)
 806                 pmic->smps457 = 1;
 807
 808         config.regmap = palmas->regmap[REGULATOR_SLAVE];
 809         config.dev = &pdev->dev;
 810         config.driver_data = pmic;
 811
 812         for (id = 0; id < PALMAS_REG_LDO1; id++) {
 813                 bool ramp_delay_support = false;
 814
 815                 /*
 816                  * Miss out regulators which are not available due
 817                  * to slaving configurations.
 818                  */
 819                 switch (id) {
 820                 case PALMAS_REG_SMPS12:
 821                 case PALMAS_REG_SMPS3:
 822                         if (pmic->smps123)
 823                                 continue;
 824                         if (id == PALMAS_REG_SMPS12)
 825                                 ramp_delay_support = true;
 826                         break;
 827                 case PALMAS_REG_SMPS123:
 828                         if (!pmic->smps123)
 829                                 continue;
 830                         ramp_delay_support = true;
 831                         break;
 832                 case PALMAS_REG_SMPS45:
 833                 case PALMAS_REG_SMPS7:
 834                         if (pmic->smps457)
 835                                 continue;
 836                         if (id == PALMAS_REG_SMPS45)
 837                                 ramp_delay_support = true;
 838                         break;
 839                 case PALMAS_REG_SMPS457:
 840                         if (!pmic->smps457)
 841                                 continue;
 842                         ramp_delay_support = true;
 843                         break;
 844                 case PALMAS_REG_SMPS10_OUT1:
 845                 case PALMAS_REG_SMPS10_OUT2:
 846                         if (!PALMAS_PMIC_HAS(palmas, SMPS10_BOOST))
 847                                 continue;
 848                 }
 849
 850                 if ((id == PALMAS_REG_SMPS6) || (id == PALMAS_REG_SMPS8))
 851                         ramp_delay_support = true;
 852
 853                 if (ramp_delay_support) {
 854                         addr = palmas_regs_info[id].tstep_addr;
 855                         ret = palmas_smps_read(pmic->palmas, addr, &reg);
 856                         if (ret < 0) {
 857                                 dev_err(&pdev->dev,
 858                                         "reading TSTEP reg failed: %d\n", ret);
 859                                 goto err_unregister_regulator;
 860                         }
 861                         pmic->desc[id].ramp_delay =
 862                                         palmas_smps_ramp_delay[reg & 0x3];
 863                         pmic->ramp_delay[id] = pmic->desc[id].ramp_delay;
 864                 }
 865
 866                 /* Initialise sleep/init values from platform data */
 867                 if (pdata && pdata->reg_init[id]) {
 868                         reg_init = pdata->reg_init[id];
 869                         ret = palmas_smps_init(palmas, id, reg_init);
 870                         if (ret)
 871                                 goto err_unregister_regulator;
 872                 }
 873
 874                 /* Register the regulators */
 875                 pmic->desc[id].name = palmas_regs_info[id].name;
 876                 pmic->desc[id].id = id;
 877
 878                 switch (id) {
 879                 case PALMAS_REG_SMPS10_OUT1:
 880                 case PALMAS_REG_SMPS10_OUT2:
 881                         pmic->desc[id].n_voltages = PALMAS_SMPS10_NUM_VOLTAGES;
 882                         pmic->desc[id].ops = &palmas_ops_smps10;
 883                         pmic->desc[id].vsel_reg =
 884                                         PALMAS_BASE_TO_REG(PALMAS_SMPS_BASE,
 885                                                         PALMAS_SMPS10_CTRL);
 886                         pmic->desc[id].vsel_mask = SMPS10_VSEL;
 887                         pmic->desc[id].enable_reg =
 888                                         PALMAS_BASE_TO_REG(PALMAS_SMPS_BASE,
 889                                                         PALMAS_SMPS10_CTRL);
 890                         if (id == PALMAS_REG_SMPS10_OUT1)
 891                                 pmic->desc[id].enable_mask = SMPS10_SWITCH_EN;
 892                         else
 893                                 pmic->desc[id].enable_mask = SMPS10_BOOST_EN;
 894                         pmic->desc[id].bypass_reg =
 895                                         PALMAS_BASE_TO_REG(PALMAS_SMPS_BASE,
 896                                                         PALMAS_SMPS10_CTRL);
 897                         pmic->desc[id].bypass_mask = SMPS10_BYPASS_EN;
 898                         pmic->desc[id].min_uV = 3750000;
 899                         pmic->desc[id].uV_step = 1250000;
 900                         break;
 901                 default:
 902                         /*
 903                          * Read and store the RANGE bit for later use
 904                          * This must be done before regulator is probed,
 905                          * otherwise we error in probe with unsupportable
 906                          * ranges. Read the current smps mode for later use.
 907                          */
 908                         addr = palmas_regs_info[id].vsel_addr;
 909
 910                         ret = palmas_smps_read(pmic->palmas, addr, &reg);
 911                         if (ret)
 912                                 goto err_unregister_regulator;
 913                         if (reg & PALMAS_SMPS12_VOLTAGE_RANGE)
 914                                 pmic->range[id] = 1;
 915
 916                         pmic->desc[id].ops = &palmas_ops_smps;
 917                         pmic->desc[id].n_voltages = PALMAS_SMPS_NUM_VOLTAGES;
 918                         pmic->desc[id].vsel_reg =
 919                                         PALMAS_BASE_TO_REG(PALMAS_SMPS_BASE,
 920                                                 palmas_regs_info[id].vsel_addr);
 921                         pmic->desc[id].vsel_mask =
 922                                         PALMAS_SMPS12_VOLTAGE_VSEL_MASK;
 923
 924                         /* Read the smps mode for later use. */
 925                         addr = palmas_regs_info[id].ctrl_addr;
 926                         ret = palmas_smps_read(pmic->palmas, addr, &reg);
 927                         if (ret)
 928                                 goto err_unregister_regulator;
 929                         pmic->current_reg_mode[id] = reg &
 930                                         PALMAS_SMPS12_CTRL_MODE_ACTIVE_MASK;
 931                 }
 932
 933                 pmic->desc[id].type = REGULATOR_VOLTAGE;
 934                 pmic->desc[id].owner = THIS_MODULE;
 935
 936                 if (pdata)
 937                         config.init_data = pdata->reg_data[id];
 938                 else
 939                         config.init_data = NULL;
 940
 941                 pmic->desc[id].supply_name = palmas_regs_info[id].sname;
 942                 config.of_node = palmas_matches[id].of_node;
 943
 944                 rdev = regulator_register(&pmic->desc[id], &config);
 945                 if (IS_ERR(rdev)) {
 946                         dev_err(&pdev->dev,
 947                                 "failed to register %s regulator\n",
 948                                 pdev->name);
 949                         ret = PTR_ERR(rdev);
 950                         goto err_unregister_regulator;
 951                 }
 952
 953                 /* Save regulator for cleanup */
 954                 pmic->rdev[id] = rdev;
 955         }
 956
 957         /* Start this loop from the id left from previous loop */
 958         for (; id < PALMAS_NUM_REGS; id++) {
 959
 960                 /* Miss out regulators which are not available due
 961                  * to alternate functions.
 962                  */
 963
 964                 /* Register the regulators */
 965                 pmic->desc[id].name = palmas_regs_info[id].name;
 966                 pmic->desc[id].id = id;
 967                 pmic->desc[id].type = REGULATOR_VOLTAGE;
 968                 pmic->desc[id].owner = THIS_MODULE;
 969
 970                 if (id < PALMAS_REG_REGEN1) {
 971                         pmic->desc[id].n_voltages = PALMAS_LDO_NUM_VOLTAGES;
 972                         pmic->desc[id].ops = &palmas_ops_ldo;
 973                         pmic->desc[id].min_uV = 900000;
 974                         pmic->desc[id].uV_step = 50000;
 975                         pmic->desc[id].linear_min_sel = 1;
 976                         pmic->desc[id].enable_time = 500;
 977                         pmic->desc[id].vsel_reg =
 978                                         PALMAS_BASE_TO_REG(PALMAS_LDO_BASE,
 979                                                 palmas_regs_info[id].vsel_addr);
 980                         pmic->desc[id].vsel_mask =
 981                                         PALMAS_LDO1_VOLTAGE_VSEL_MASK;
 982                         pmic->desc[id].enable_reg =
 983                                         PALMAS_BASE_TO_REG(PALMAS_LDO_BASE,
 984                                                 palmas_regs_info[id].ctrl_addr);
 985                         pmic->desc[id].enable_mask =
 986                                         PALMAS_LDO1_CTRL_MODE_ACTIVE;
 987
 988                         /* Check if LDO8 is in tracking mode or not */
 989                         if (pdata && (id == PALMAS_REG_LDO8) &&
 990                                         pdata->enable_ldo8_tracking) {
 991                                 palmas_enable_ldo8_track(palmas);
 992                                 pmic->desc[id].min_uV = 450000;
 993                                 pmic->desc[id].uV_step = 25000;
 994                         }
 995
 996                         /* LOD6 in vibrator mode will have enable time 2000us */
 997                         if (pdata && pdata->ldo6_vibrator &&
 998                                 (id == PALMAS_REG_LDO6))
 999                                 pmic->desc[id].enable_time = 2000;
1000                 } else {
1001                         pmic->desc[id].n_voltages = 1;
1002                         pmic->desc[id].ops = &palmas_ops_extreg;
1003                         pmic->desc[id].enable_reg =
1004                                         PALMAS_BASE_TO_REG(PALMAS_RESOURCE_BASE,
1005                                                 palmas_regs_info[id].ctrl_addr);
1006                         pmic->desc[id].enable_mask =
1007                                         PALMAS_REGEN1_CTRL_MODE_ACTIVE;
1008                 }
1009
1010                 if (pdata)
1011                         config.init_data = pdata->reg_data[id];
1012                 else
1013                         config.init_data = NULL;
1014
1015                 pmic->desc[id].supply_name = palmas_regs_info[id].sname;
1016                 config.of_node = palmas_matches[id].of_node;
1017
1018                 rdev = regulator_register(&pmic->desc[id], &config);
1019                 if (IS_ERR(rdev)) {
1020                         dev_err(&pdev->dev,
1021                                 "failed to register %s regulator\n",
1022                                 pdev->name);
1023                         ret = PTR_ERR(rdev);
1024                         goto err_unregister_regulator;
1025                 }
1026
1027                 /* Save regulator for cleanup */
1028                 pmic->rdev[id] = rdev;
1029
1030                 /* Initialise sleep/init values from platform data */
1031                 if (pdata) {
1032                         reg_init = pdata->reg_init[id];
1033                         if (reg_init) {
1034                                 if (id < PALMAS_REG_REGEN1)
1035                                         ret = palmas_ldo_init(palmas,
1036                                                         id, reg_init);
1037                                 else
1038                                         ret = palmas_extreg_init(palmas,
1039                                                         id, reg_init);
1040                                 if (ret) {
1041                                         regulator_unregister(pmic->rdev[id]);
1042                                         goto err_unregister_regulator;
1043                                 }
1044                         }
1045                 }
1046         }
1047
1048
1049         return 0;
1050
1051 err_unregister_regulator:
1052         while (--id >= 0)
1053                 regulator_unregister(pmic->rdev[id]);
1054         return ret;
1055 }
1056
1057 static int palmas_regulators_remove(struct platform_device *pdev)
1058 {
1059         struct palmas_pmic *pmic = platform_get_drvdata(pdev);
1060         int id;
1061
1062         for (id = 0; id < PALMAS_NUM_REGS; id++)
1063                 regulator_unregister(pmic->rdev[id]);
1064         return 0;
1065 }
1066
1067 static struct of_device_id of_palmas_match_tbl[] = {
1068         { .compatible = "ti,palmas-pmic", },
1069         { .compatible = "ti,twl6035-pmic", },
1070         { .compatible = "ti,twl6036-pmic", },
1071         { .compatible = "ti,twl6037-pmic", },
1072         { .compatible = "ti,tps65913-pmic", },
1073         { .compatible = "ti,tps65914-pmic", },
1074         { .compatible = "ti,tps80036-pmic", },
1075         { .compatible = "ti,tps659038-pmic", },
1076         { /* end */ }
1077 };
1078
1079 static struct platform_driver palmas_driver = {
1080         .driver = {
1081                 .name = "palmas-pmic",
1082                 .of_match_table = of_palmas_match_tbl,
1083                 .owner = THIS_MODULE,
1084         },
1085         .probe = palmas_regulators_probe,
1086         .remove = palmas_regulators_remove,
1087 };
1088
1089 static int __init palmas_init(void)
1090 {
1091         return platform_driver_register(&palmas_driver);
1092 }
1093 subsys_initcall(palmas_init);
1094
1095 static void __exit palmas_exit(void)
1096 {
1097         platform_driver_unregister(&palmas_driver);
1098 }
1099 module_exit(palmas_exit);
1100
1101 MODULE_AUTHOR("Graeme Gregory <gg@slimlogic.co.uk>");
1102 MODULE_DESCRIPTION("Palmas voltage regulator driver");
1103 MODULE_LICENSE("GPL");
1104 MODULE_ALIAS("platform:palmas-pmic");
1105 MODULE_DEVICE_TABLE(of, of_palmas_match_tbl);