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