drivers/regulator/as3722-regulator.c

   1 /*
   2  * Voltage regulator support for AMS AS3722 PMIC
   3  *
   4  * Copyright (C) 2013 ams
   5  *
   6  * Author: Florian Lobmaier <florian.lobmaier@ams.com>
   7  * Author: Laxman Dewangan <ldewangan@nvidia.com>
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License as published by
  11  * the Free Software Foundation; either version 2 of the License, or
  12  * (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  22  *
  23  */
  24
  25 #include <linux/err.h>
  26 #include <linux/kernel.h>
  27 #include <linux/module.h>
  28 #include <linux/mfd/as3722.h>
  29 #include <linux/of.h>
  30 #include <linux/of_platform.h>
  31 #include <linux/platform_device.h>
  32 #include <linux/regulator/driver.h>
  33 #include <linux/regulator/machine.h>
  34 #include <linux/regulator/of_regulator.h>
  35 #include <linux/slab.h>
  36
  37 /* Regulator IDs */
  38 enum as3722_regulators_id {
  39         AS3722_REGULATOR_ID_SD0,
  40         AS3722_REGULATOR_ID_SD1,
  41         AS3722_REGULATOR_ID_SD2,
  42         AS3722_REGULATOR_ID_SD3,
  43         AS3722_REGULATOR_ID_SD4,
  44         AS3722_REGULATOR_ID_SD5,
  45         AS3722_REGULATOR_ID_SD6,
  46         AS3722_REGULATOR_ID_LDO0,
  47         AS3722_REGULATOR_ID_LDO1,
  48         AS3722_REGULATOR_ID_LDO2,
  49         AS3722_REGULATOR_ID_LDO3,
  50         AS3722_REGULATOR_ID_LDO4,
  51         AS3722_REGULATOR_ID_LDO5,
  52         AS3722_REGULATOR_ID_LDO6,
  53         AS3722_REGULATOR_ID_LDO7,
  54         AS3722_REGULATOR_ID_LDO9,
  55         AS3722_REGULATOR_ID_LDO10,
  56         AS3722_REGULATOR_ID_LDO11,
  57         AS3722_REGULATOR_ID_MAX,
  58 };
  59
  60 struct as3722_register_mapping {
  61         u8 regulator_id;
  62         const char *name;
  63         const char *sname;
  64         u8 vsel_reg;
  65         u8 vsel_mask;
  66         int n_voltages;
  67         u32 enable_reg;
  68         u8 enable_mask;
  69         u32 control_reg;
  70         u8 mode_mask;
  71         u32 sleep_ctrl_reg;
  72         u8 sleep_ctrl_mask;
  73 };
  74
  75 struct as3722_regulator_config_data {
  76         struct regulator_init_data *reg_init;
  77         bool enable_tracking;
  78         int ext_control;
  79 };
  80
  81 struct as3722_regulators {
  82         struct device *dev;
  83         struct as3722 *as3722;
  84         struct regulator_dev *rdevs[AS3722_REGULATOR_ID_MAX];
  85         struct regulator_desc desc[AS3722_REGULATOR_ID_MAX];
  86         struct as3722_regulator_config_data
  87                         reg_config_data[AS3722_REGULATOR_ID_MAX];
  88 };
  89
  90 static const struct as3722_register_mapping as3722_reg_lookup[] = {
  91         {
  92                 .regulator_id = AS3722_REGULATOR_ID_SD0,
  93                 .name = "as3722-sd0",
  94                 .vsel_reg = AS3722_SD0_VOLTAGE_REG,
  95                 .vsel_mask = AS3722_SD_VSEL_MASK,
  96                 .enable_reg = AS3722_SD_CONTROL_REG,
  97                 .enable_mask = AS3722_SDn_CTRL(0),
  98                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL1_REG,
  99                 .sleep_ctrl_mask = AS3722_SD0_EXT_ENABLE_MASK,
 100                 .control_reg = AS3722_SD0_CONTROL_REG,
 101                 .mode_mask = AS3722_SD0_MODE_FAST,
 102         },
 103         {
 104                 .regulator_id = AS3722_REGULATOR_ID_SD1,
 105                 .name = "as3722-sd1",
 106                 .vsel_reg = AS3722_SD1_VOLTAGE_REG,
 107                 .vsel_mask = AS3722_SD_VSEL_MASK,
 108                 .enable_reg = AS3722_SD_CONTROL_REG,
 109                 .enable_mask = AS3722_SDn_CTRL(1),
 110                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL1_REG,
 111                 .sleep_ctrl_mask = AS3722_SD1_EXT_ENABLE_MASK,
 112                 .control_reg = AS3722_SD1_CONTROL_REG,
 113                 .mode_mask = AS3722_SD1_MODE_FAST,
 114         },
 115         {
 116                 .regulator_id = AS3722_REGULATOR_ID_SD2,
 117                 .name = "as3722-sd2",
 118                 .sname = "vsup-sd2",
 119                 .vsel_reg = AS3722_SD2_VOLTAGE_REG,
 120                 .vsel_mask = AS3722_SD_VSEL_MASK,
 121                 .enable_reg = AS3722_SD_CONTROL_REG,
 122                 .enable_mask = AS3722_SDn_CTRL(2),
 123                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL1_REG,
 124                 .sleep_ctrl_mask = AS3722_SD2_EXT_ENABLE_MASK,
 125                 .control_reg = AS3722_SD23_CONTROL_REG,
 126                 .mode_mask = AS3722_SD2_MODE_FAST,
 127                 .n_voltages = AS3722_SD2_VSEL_MAX + 1,
 128         },
 129         {
 130                 .regulator_id = AS3722_REGULATOR_ID_SD3,
 131                 .name = "as3722-sd3",
 132                 .sname = "vsup-sd3",
 133                 .vsel_reg = AS3722_SD3_VOLTAGE_REG,
 134                 .vsel_mask = AS3722_SD_VSEL_MASK,
 135                 .enable_reg = AS3722_SD_CONTROL_REG,
 136                 .enable_mask = AS3722_SDn_CTRL(3),
 137                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL1_REG,
 138                 .sleep_ctrl_mask = AS3722_SD3_EXT_ENABLE_MASK,
 139                 .control_reg = AS3722_SD23_CONTROL_REG,
 140                 .mode_mask = AS3722_SD3_MODE_FAST,
 141                 .n_voltages = AS3722_SD2_VSEL_MAX + 1,
 142         },
 143         {
 144                 .regulator_id = AS3722_REGULATOR_ID_SD4,
 145                 .name = "as3722-sd4",
 146                 .sname = "vsup-sd4",
 147                 .vsel_reg = AS3722_SD4_VOLTAGE_REG,
 148                 .vsel_mask = AS3722_SD_VSEL_MASK,
 149                 .enable_reg = AS3722_SD_CONTROL_REG,
 150                 .enable_mask = AS3722_SDn_CTRL(4),
 151                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL2_REG,
 152                 .sleep_ctrl_mask = AS3722_SD4_EXT_ENABLE_MASK,
 153                 .control_reg = AS3722_SD4_CONTROL_REG,
 154                 .mode_mask = AS3722_SD4_MODE_FAST,
 155                 .n_voltages = AS3722_SD2_VSEL_MAX + 1,
 156         },
 157         {
 158                 .regulator_id = AS3722_REGULATOR_ID_SD5,
 159                 .name = "as3722-sd5",
 160                 .sname = "vsup-sd5",
 161                 .vsel_reg = AS3722_SD5_VOLTAGE_REG,
 162                 .vsel_mask = AS3722_SD_VSEL_MASK,
 163                 .enable_reg = AS3722_SD_CONTROL_REG,
 164                 .enable_mask = AS3722_SDn_CTRL(5),
 165                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL2_REG,
 166                 .sleep_ctrl_mask = AS3722_SD5_EXT_ENABLE_MASK,
 167                 .control_reg = AS3722_SD5_CONTROL_REG,
 168                 .mode_mask = AS3722_SD5_MODE_FAST,
 169                 .n_voltages = AS3722_SD2_VSEL_MAX + 1,
 170         },
 171         {
 172                 .regulator_id = AS3722_REGULATOR_ID_SD6,
 173                 .name = "as3722-sd6",
 174                 .vsel_reg = AS3722_SD6_VOLTAGE_REG,
 175                 .vsel_mask = AS3722_SD_VSEL_MASK,
 176                 .enable_reg = AS3722_SD_CONTROL_REG,
 177                 .enable_mask = AS3722_SDn_CTRL(6),
 178                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL2_REG,
 179                 .sleep_ctrl_mask = AS3722_SD6_EXT_ENABLE_MASK,
 180                 .control_reg = AS3722_SD6_CONTROL_REG,
 181                 .mode_mask = AS3722_SD6_MODE_FAST,
 182         },
 183         {
 184                 .regulator_id = AS3722_REGULATOR_ID_LDO0,
 185                 .name = "as3722-ldo0",
 186                 .sname = "vin-ldo0",
 187                 .vsel_reg = AS3722_LDO0_VOLTAGE_REG,
 188                 .vsel_mask = AS3722_LDO0_VSEL_MASK,
 189                 .enable_reg = AS3722_LDOCONTROL0_REG,
 190                 .enable_mask = AS3722_LDO0_CTRL,
 191                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL3_REG,
 192                 .sleep_ctrl_mask = AS3722_LDO0_EXT_ENABLE_MASK,
 193                 .n_voltages = AS3722_LDO0_NUM_VOLT,
 194         },
 195         {
 196                 .regulator_id = AS3722_REGULATOR_ID_LDO1,
 197                 .name = "as3722-ldo1",
 198                 .sname = "vin-ldo1-6",
 199                 .vsel_reg = AS3722_LDO1_VOLTAGE_REG,
 200                 .vsel_mask = AS3722_LDO_VSEL_MASK,
 201                 .enable_reg = AS3722_LDOCONTROL0_REG,
 202                 .enable_mask = AS3722_LDO1_CTRL,
 203                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL3_REG,
 204                 .sleep_ctrl_mask = AS3722_LDO1_EXT_ENABLE_MASK,
 205                 .n_voltages = AS3722_LDO_NUM_VOLT,
 206         },
 207         {
 208                 .regulator_id = AS3722_REGULATOR_ID_LDO2,
 209                 .name = "as3722-ldo2",
 210                 .sname = "vin-ldo2-5-7",
 211                 .vsel_reg = AS3722_LDO2_VOLTAGE_REG,
 212                 .vsel_mask = AS3722_LDO_VSEL_MASK,
 213                 .enable_reg = AS3722_LDOCONTROL0_REG,
 214                 .enable_mask = AS3722_LDO2_CTRL,
 215                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL3_REG,
 216                 .sleep_ctrl_mask = AS3722_LDO2_EXT_ENABLE_MASK,
 217                 .n_voltages = AS3722_LDO_NUM_VOLT,
 218         },
 219         {
 220                 .regulator_id = AS3722_REGULATOR_ID_LDO3,
 221                 .name = "as3722-ldo3",
 222                 .sname = "vin-ldo3-4",
 223                 .vsel_reg = AS3722_LDO3_VOLTAGE_REG,
 224                 .vsel_mask = AS3722_LDO3_VSEL_MASK,
 225                 .enable_reg = AS3722_LDOCONTROL0_REG,
 226                 .enable_mask = AS3722_LDO3_CTRL,
 227                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL3_REG,
 228                 .sleep_ctrl_mask = AS3722_LDO3_EXT_ENABLE_MASK,
 229                 .n_voltages = AS3722_LDO3_NUM_VOLT,
 230         },
 231         {
 232                 .regulator_id = AS3722_REGULATOR_ID_LDO4,
 233                 .name = "as3722-ldo4",
 234                 .sname = "vin-ldo3-4",
 235                 .vsel_reg = AS3722_LDO4_VOLTAGE_REG,
 236                 .vsel_mask = AS3722_LDO_VSEL_MASK,
 237                 .enable_reg = AS3722_LDOCONTROL0_REG,
 238                 .enable_mask = AS3722_LDO4_CTRL,
 239                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL4_REG,
 240                 .sleep_ctrl_mask = AS3722_LDO4_EXT_ENABLE_MASK,
 241                 .n_voltages = AS3722_LDO_NUM_VOLT,
 242         },
 243         {
 244                 .regulator_id = AS3722_REGULATOR_ID_LDO5,
 245                 .name = "as3722-ldo5",
 246                 .sname = "vin-ldo2-5-7",
 247                 .vsel_reg = AS3722_LDO5_VOLTAGE_REG,
 248                 .vsel_mask = AS3722_LDO_VSEL_MASK,
 249                 .enable_reg = AS3722_LDOCONTROL0_REG,
 250                 .enable_mask = AS3722_LDO5_CTRL,
 251                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL4_REG,
 252                 .sleep_ctrl_mask = AS3722_LDO5_EXT_ENABLE_MASK,
 253                 .n_voltages = AS3722_LDO_NUM_VOLT,
 254         },
 255         {
 256                 .regulator_id = AS3722_REGULATOR_ID_LDO6,
 257                 .name = "as3722-ldo6",
 258                 .sname = "vin-ldo1-6",
 259                 .vsel_reg = AS3722_LDO6_VOLTAGE_REG,
 260                 .vsel_mask = AS3722_LDO_VSEL_MASK,
 261                 .enable_reg = AS3722_LDOCONTROL0_REG,
 262                 .enable_mask = AS3722_LDO6_CTRL,
 263                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL4_REG,
 264                 .sleep_ctrl_mask = AS3722_LDO6_EXT_ENABLE_MASK,
 265                 .n_voltages = AS3722_LDO_NUM_VOLT,
 266         },
 267         {
 268                 .regulator_id = AS3722_REGULATOR_ID_LDO7,
 269                 .name = "as3722-ldo7",
 270                 .sname = "vin-ldo2-5-7",
 271                 .vsel_reg = AS3722_LDO7_VOLTAGE_REG,
 272                 .vsel_mask = AS3722_LDO_VSEL_MASK,
 273                 .enable_reg = AS3722_LDOCONTROL0_REG,
 274                 .enable_mask = AS3722_LDO7_CTRL,
 275                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL4_REG,
 276                 .sleep_ctrl_mask = AS3722_LDO7_EXT_ENABLE_MASK,
 277                 .n_voltages = AS3722_LDO_NUM_VOLT,
 278         },
 279         {
 280                 .regulator_id = AS3722_REGULATOR_ID_LDO9,
 281                 .name = "as3722-ldo9",
 282                 .sname = "vin-ldo9-10",
 283                 .vsel_reg = AS3722_LDO9_VOLTAGE_REG,
 284                 .vsel_mask = AS3722_LDO_VSEL_MASK,
 285                 .enable_reg = AS3722_LDOCONTROL1_REG,
 286                 .enable_mask = AS3722_LDO9_CTRL,
 287                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL5_REG,
 288                 .sleep_ctrl_mask = AS3722_LDO9_EXT_ENABLE_MASK,
 289                 .n_voltages = AS3722_LDO_NUM_VOLT,
 290         },
 291         {
 292                 .regulator_id = AS3722_REGULATOR_ID_LDO10,
 293                 .name = "as3722-ldo10",
 294                 .sname = "vin-ldo9-10",
 295                 .vsel_reg = AS3722_LDO10_VOLTAGE_REG,
 296                 .vsel_mask = AS3722_LDO_VSEL_MASK,
 297                 .enable_reg = AS3722_LDOCONTROL1_REG,
 298                 .enable_mask = AS3722_LDO10_CTRL,
 299                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL5_REG,
 300                 .sleep_ctrl_mask = AS3722_LDO10_EXT_ENABLE_MASK,
 301                 .n_voltages = AS3722_LDO_NUM_VOLT,
 302         },
 303         {
 304                 .regulator_id = AS3722_REGULATOR_ID_LDO11,
 305                 .name = "as3722-ldo11",
 306                 .sname = "vin-ldo11",
 307                 .vsel_reg = AS3722_LDO11_VOLTAGE_REG,
 308                 .vsel_mask = AS3722_LDO_VSEL_MASK,
 309                 .enable_reg = AS3722_LDOCONTROL1_REG,
 310                 .enable_mask = AS3722_LDO11_CTRL,
 311                 .sleep_ctrl_reg = AS3722_ENABLE_CTRL5_REG,
 312                 .sleep_ctrl_mask = AS3722_LDO11_EXT_ENABLE_MASK,
 313                 .n_voltages = AS3722_LDO_NUM_VOLT,
 314         },
 315 };
 316
 317
 318 static const int as3722_ldo_current[] = { 150000, 300000 };
 319 static const int as3722_sd016_current[] = { 2500000, 3000000, 3500000 };
 320
 321 static int as3722_current_to_index(int min_uA, int max_uA,
 322                 const int *curr_table, int n_currents)
 323 {
 324         int i;
 325
 326         for (i = n_currents - 1; i >= 0; i--) {
 327                 if ((min_uA <= curr_table[i]) && (curr_table[i] <= max_uA))
 328                         return i;
 329         }
 330         return -EINVAL;
 331 }
 332
 333 static int as3722_ldo_get_current_limit(struct regulator_dev *rdev)
 334 {
 335         struct as3722_regulators *as3722_regs = rdev_get_drvdata(rdev);
 336         struct as3722 *as3722 = as3722_regs->as3722;
 337         int id = rdev_get_id(rdev);
 338         u32 val;
 339         int ret;
 340
 341         ret = as3722_read(as3722, as3722_reg_lookup[id].vsel_reg, &val);
 342         if (ret < 0) {
 343                 dev_err(as3722_regs->dev, "Reg 0x%02x read failed: %d\n",
 344                         as3722_reg_lookup[id].vsel_reg, ret);
 345                 return ret;
 346         }
 347         if (val & AS3722_LDO_ILIMIT_MASK)
 348                 return 300000;
 349         return 150000;
 350 }
 351
 352 static int as3722_ldo_set_current_limit(struct regulator_dev *rdev,
 353                 int min_uA, int max_uA)
 354 {
 355         struct as3722_regulators *as3722_regs = rdev_get_drvdata(rdev);
 356         struct as3722 *as3722 = as3722_regs->as3722;
 357         int id = rdev_get_id(rdev);
 358         int ret;
 359         u32 reg = 0;
 360
 361         ret = as3722_current_to_index(min_uA, max_uA, as3722_ldo_current,
 362                                 ARRAY_SIZE(as3722_ldo_current));
 363         if (ret < 0) {
 364                 dev_err(as3722_regs->dev,
 365                         "Current range min:max = %d:%d does not support\n",
 366                         min_uA, max_uA);
 367                 return ret;
 368         }
 369         if (ret)
 370                 reg = AS3722_LDO_ILIMIT_BIT;
 371         return as3722_update_bits(as3722, as3722_reg_lookup[id].vsel_reg,
 372                         AS3722_LDO_ILIMIT_MASK, reg);
 373 }
 374
 375 static struct regulator_ops as3722_ldo0_ops = {
 376         .is_enabled = regulator_is_enabled_regmap,
 377         .enable = regulator_enable_regmap,
 378         .disable = regulator_disable_regmap,
 379         .list_voltage = regulator_list_voltage_linear,
 380         .get_voltage_sel = regulator_get_voltage_sel_regmap,
 381         .set_voltage_sel = regulator_set_voltage_sel_regmap,
 382         .get_current_limit = as3722_ldo_get_current_limit,
 383         .set_current_limit = as3722_ldo_set_current_limit,
 384 };
 385
 386 static struct regulator_ops as3722_ldo0_extcntrl_ops = {
 387         .list_voltage = regulator_list_voltage_linear,
 388         .get_voltage_sel = regulator_get_voltage_sel_regmap,
 389         .set_voltage_sel = regulator_set_voltage_sel_regmap,
 390         .get_current_limit = as3722_ldo_get_current_limit,
 391         .set_current_limit = as3722_ldo_set_current_limit,
 392 };
 393
 394 static int as3722_ldo3_set_tracking_mode(struct as3722_regulators *as3722_reg,
 395                 int id, u8 mode)
 396 {
 397         struct as3722 *as3722 = as3722_reg->as3722;
 398
 399         switch (mode) {
 400         case AS3722_LDO3_MODE_PMOS:
 401         case AS3722_LDO3_MODE_PMOS_TRACKING:
 402         case AS3722_LDO3_MODE_NMOS:
 403         case AS3722_LDO3_MODE_SWITCH:
 404                 return as3722_update_bits(as3722,
 405                         as3722_reg_lookup[id].vsel_reg,
 406                         AS3722_LDO3_MODE_MASK, mode);
 407
 408         default:
 409                 return -EINVAL;
 410         }
 411 }
 412
 413 static int as3722_ldo3_get_current_limit(struct regulator_dev *rdev)
 414 {
 415         return 150000;
 416 }
 417
 418 static struct regulator_ops as3722_ldo3_ops = {
 419         .is_enabled = regulator_is_enabled_regmap,
 420         .enable = regulator_enable_regmap,
 421         .disable = regulator_disable_regmap,
 422         .list_voltage = regulator_list_voltage_linear,
 423         .get_voltage_sel = regulator_get_voltage_sel_regmap,
 424         .set_voltage_sel = regulator_set_voltage_sel_regmap,
 425         .get_current_limit = as3722_ldo3_get_current_limit,
 426 };
 427
 428 static struct regulator_ops as3722_ldo3_extcntrl_ops = {
 429         .list_voltage = regulator_list_voltage_linear,
 430         .get_voltage_sel = regulator_get_voltage_sel_regmap,
 431         .set_voltage_sel = regulator_set_voltage_sel_regmap,
 432         .get_current_limit = as3722_ldo3_get_current_limit,
 433 };
 434
 435 static const struct regulator_linear_range as3722_ldo_ranges[] = {
 436         REGULATOR_LINEAR_RANGE(0, 0x00, 0x00, 0),
 437         REGULATOR_LINEAR_RANGE(825000, 0x01, 0x24, 25000),
 438         REGULATOR_LINEAR_RANGE(1725000, 0x40, 0x7F, 25000),
 439 };
 440
 441 static struct regulator_ops as3722_ldo_ops = {
 442         .is_enabled = regulator_is_enabled_regmap,
 443         .enable = regulator_enable_regmap,
 444         .disable = regulator_disable_regmap,
 445         .map_voltage = regulator_map_voltage_linear_range,
 446         .set_voltage_sel = regulator_set_voltage_sel_regmap,
 447         .get_voltage_sel = regulator_get_voltage_sel_regmap,
 448         .list_voltage = regulator_list_voltage_linear_range,
 449         .get_current_limit = as3722_ldo_get_current_limit,
 450         .set_current_limit = as3722_ldo_set_current_limit,
 451 };
 452
 453 static struct regulator_ops as3722_ldo_extcntrl_ops = {
 454         .map_voltage = regulator_map_voltage_linear_range,
 455         .set_voltage_sel = regulator_set_voltage_sel_regmap,
 456         .get_voltage_sel = regulator_get_voltage_sel_regmap,
 457         .list_voltage = regulator_list_voltage_linear_range,
 458         .get_current_limit = as3722_ldo_get_current_limit,
 459         .set_current_limit = as3722_ldo_set_current_limit,
 460 };
 461
 462 static unsigned int as3722_sd_get_mode(struct regulator_dev *rdev)
 463 {
 464         struct as3722_regulators *as3722_regs = rdev_get_drvdata(rdev);
 465         struct as3722 *as3722 = as3722_regs->as3722;
 466         int id = rdev_get_id(rdev);
 467         u32 val;
 468         int ret;
 469
 470         if (!as3722_reg_lookup[id].control_reg)
 471                 return -ENOTSUPP;
 472
 473         ret = as3722_read(as3722, as3722_reg_lookup[id].control_reg, &val);
 474         if (ret < 0) {
 475                 dev_err(as3722_regs->dev, "Reg 0x%02x read failed: %d\n",
 476                         as3722_reg_lookup[id].control_reg, ret);
 477                 return ret;
 478         }
 479
 480         if (val & as3722_reg_lookup[id].mode_mask)
 481                 return REGULATOR_MODE_FAST;
 482         else
 483                 return REGULATOR_MODE_NORMAL;
 484 }
 485
 486 static int as3722_sd_set_mode(struct regulator_dev *rdev,
 487                 unsigned int mode)
 488 {
 489         struct as3722_regulators *as3722_regs = rdev_get_drvdata(rdev);
 490         struct as3722 *as3722 = as3722_regs->as3722;
 491         u8 id = rdev_get_id(rdev);
 492         u8 val = 0;
 493         int ret;
 494
 495         if (!as3722_reg_lookup[id].control_reg)
 496                 return -ERANGE;
 497
 498         switch (mode) {
 499         case REGULATOR_MODE_FAST:
 500                 val = as3722_reg_lookup[id].mode_mask;
 501         case REGULATOR_MODE_NORMAL: /* fall down */
 502                 break;
 503         default:
 504                 return -EINVAL;
 505         }
 506
 507         ret = as3722_update_bits(as3722, as3722_reg_lookup[id].control_reg,
 508                         as3722_reg_lookup[id].mode_mask, val);
 509         if (ret < 0) {
 510                 dev_err(as3722_regs->dev, "Reg 0x%02x update failed: %d\n",
 511                         as3722_reg_lookup[id].control_reg, ret);
 512                 return ret;
 513         }
 514         return ret;
 515 }
 516
 517 static int as3722_sd016_get_current_limit(struct regulator_dev *rdev)
 518 {
 519         struct as3722_regulators *as3722_regs = rdev_get_drvdata(rdev);
 520         struct as3722 *as3722 = as3722_regs->as3722;
 521         int id = rdev_get_id(rdev);
 522         u32 val, reg;
 523         int mask;
 524         int ret;
 525
 526         switch (id) {
 527         case AS3722_REGULATOR_ID_SD0:
 528                 reg = AS3722_OVCURRENT_REG;
 529                 mask = AS3722_OVCURRENT_SD0_TRIP_MASK;
 530                 break;
 531         case AS3722_REGULATOR_ID_SD1:
 532                 reg = AS3722_OVCURRENT_REG;
 533                 mask = AS3722_OVCURRENT_SD1_TRIP_MASK;
 534                 break;
 535         case AS3722_REGULATOR_ID_SD6:
 536                 reg = AS3722_OVCURRENT_DEB_REG;
 537                 mask = AS3722_OVCURRENT_SD6_TRIP_MASK;
 538                 break;
 539         default:
 540                 return -EINVAL;
 541         }
 542         ret = as3722_read(as3722, reg, &val);
 543         if (ret < 0) {
 544                 dev_err(as3722_regs->dev, "Reg 0x%02x read failed: %d\n",
 545                         reg, ret);
 546                 return ret;
 547         }
 548         val &= mask;
 549         val >>= ffs(mask) - 1;
 550         if (val == 3)
 551                 return -EINVAL;
 552         return as3722_sd016_current[val];
 553 }
 554
 555 static int as3722_sd016_set_current_limit(struct regulator_dev *rdev,
 556                 int min_uA, int max_uA)
 557 {
 558         struct as3722_regulators *as3722_regs = rdev_get_drvdata(rdev);
 559         struct as3722 *as3722 = as3722_regs->as3722;
 560         int id = rdev_get_id(rdev);
 561         int ret;
 562         int val;
 563         int mask;
 564         u32 reg;
 565
 566         ret = as3722_current_to_index(min_uA, max_uA, as3722_sd016_current,
 567                                 ARRAY_SIZE(as3722_sd016_current));
 568         if (ret < 0) {
 569                 dev_err(as3722_regs->dev,
 570                         "Current range min:max = %d:%d does not support\n",
 571                         min_uA, max_uA);
 572                 return ret;
 573         }
 574
 575         switch (id) {
 576         case AS3722_REGULATOR_ID_SD0:
 577                 reg = AS3722_OVCURRENT_REG;
 578                 mask = AS3722_OVCURRENT_SD0_TRIP_MASK;
 579                 break;
 580         case AS3722_REGULATOR_ID_SD1:
 581                 reg = AS3722_OVCURRENT_REG;
 582                 mask = AS3722_OVCURRENT_SD1_TRIP_MASK;
 583                 break;
 584         case AS3722_REGULATOR_ID_SD6:
 585                 reg = AS3722_OVCURRENT_DEB_REG;
 586                 mask = AS3722_OVCURRENT_SD6_TRIP_MASK;
 587                 break;
 588         default:
 589                 return -EINVAL;
 590         }
 591         ret <<= ffs(mask) - 1;
 592         val = ret & mask;
 593         return as3722_update_bits(as3722, reg, mask, val);
 594 }
 595
 596 static bool as3722_sd0_is_low_voltage(struct as3722_regulators *as3722_regs)
 597 {
 598         int err;
 599         unsigned val;
 600
 601         err = as3722_read(as3722_regs->as3722, AS3722_FUSE7_REG, &val);
 602         if (err < 0) {
 603                 dev_err(as3722_regs->dev, "Reg 0x%02x read failed: %d\n",
 604                         AS3722_FUSE7_REG, err);
 605                 return false;
 606         }
 607         if (val & AS3722_FUSE7_SD0_LOW_VOLTAGE)
 608                 return true;
 609         return false;
 610 }
 611
 612 static const struct regulator_linear_range as3722_sd2345_ranges[] = {
 613         REGULATOR_LINEAR_RANGE(0, 0x00, 0x00, 0),
 614         REGULATOR_LINEAR_RANGE(612500, 0x01, 0x40, 12500),
 615         REGULATOR_LINEAR_RANGE(1425000, 0x41, 0x70, 25000),
 616         REGULATOR_LINEAR_RANGE(2650000, 0x71, 0x7F, 50000),
 617 };
 618
 619 static struct regulator_ops as3722_sd016_ops = {
 620         .is_enabled = regulator_is_enabled_regmap,
 621         .enable = regulator_enable_regmap,
 622         .disable = regulator_disable_regmap,
 623         .list_voltage = regulator_list_voltage_linear,
 624         .map_voltage = regulator_map_voltage_linear,
 625         .get_voltage_sel = regulator_get_voltage_sel_regmap,
 626         .set_voltage_sel = regulator_set_voltage_sel_regmap,
 627         .get_current_limit = as3722_sd016_get_current_limit,
 628         .set_current_limit = as3722_sd016_set_current_limit,
 629         .get_mode = as3722_sd_get_mode,
 630         .set_mode = as3722_sd_set_mode,
 631 };
 632
 633 static struct regulator_ops as3722_sd016_extcntrl_ops = {
 634         .list_voltage = regulator_list_voltage_linear,
 635         .map_voltage = regulator_map_voltage_linear,
 636         .get_voltage_sel = regulator_get_voltage_sel_regmap,
 637         .set_voltage_sel = regulator_set_voltage_sel_regmap,
 638         .get_current_limit = as3722_sd016_get_current_limit,
 639         .set_current_limit = as3722_sd016_set_current_limit,
 640         .get_mode = as3722_sd_get_mode,
 641         .set_mode = as3722_sd_set_mode,
 642 };
 643
 644 static struct regulator_ops as3722_sd2345_ops = {
 645         .is_enabled = regulator_is_enabled_regmap,
 646         .enable = regulator_enable_regmap,
 647         .disable = regulator_disable_regmap,
 648         .list_voltage = regulator_list_voltage_linear_range,
 649         .map_voltage = regulator_map_voltage_linear_range,
 650         .set_voltage_sel = regulator_set_voltage_sel_regmap,
 651         .get_voltage_sel = regulator_get_voltage_sel_regmap,
 652         .get_mode = as3722_sd_get_mode,
 653         .set_mode = as3722_sd_set_mode,
 654 };
 655
 656 static struct regulator_ops as3722_sd2345_extcntrl_ops = {
 657         .list_voltage = regulator_list_voltage_linear_range,
 658         .map_voltage = regulator_map_voltage_linear_range,
 659         .set_voltage_sel = regulator_set_voltage_sel_regmap,
 660         .get_voltage_sel = regulator_get_voltage_sel_regmap,
 661         .get_mode = as3722_sd_get_mode,
 662         .set_mode = as3722_sd_set_mode,
 663 };
 664
 665 static int as3722_extreg_init(struct as3722_regulators *as3722_regs, int id,
 666                 int ext_pwr_ctrl)
 667 {
 668         int ret;
 669         unsigned int val;
 670
 671         if ((ext_pwr_ctrl < AS3722_EXT_CONTROL_ENABLE1) ||
 672                 (ext_pwr_ctrl > AS3722_EXT_CONTROL_ENABLE3))
 673                 return -EINVAL;
 674
 675         val =  ext_pwr_ctrl << (ffs(as3722_reg_lookup[id].sleep_ctrl_mask) - 1);
 676         ret = as3722_update_bits(as3722_regs->as3722,
 677                         as3722_reg_lookup[id].sleep_ctrl_reg,
 678                         as3722_reg_lookup[id].sleep_ctrl_mask, val);
 679         if (ret < 0)
 680                 dev_err(as3722_regs->dev, "Reg 0x%02x update failed: %d\n",
 681                         as3722_reg_lookup[id].sleep_ctrl_reg, ret);
 682         return ret;
 683 }
 684
 685 static struct of_regulator_match as3722_regulator_matches[] = {
 686         { .name = "sd0", },
 687         { .name = "sd1", },
 688         { .name = "sd2", },
 689         { .name = "sd3", },
 690         { .name = "sd4", },
 691         { .name = "sd5", },
 692         { .name = "sd6", },
 693         { .name = "ldo0", },
 694         { .name = "ldo1", },
 695         { .name = "ldo2", },
 696         { .name = "ldo3", },
 697         { .name = "ldo4", },
 698         { .name = "ldo5", },
 699         { .name = "ldo6", },
 700         { .name = "ldo7", },
 701         { .name = "ldo9", },
 702         { .name = "ldo10", },
 703         { .name = "ldo11", },
 704 };
 705
 706 static int as3722_get_regulator_dt_data(struct platform_device *pdev,
 707                 struct as3722_regulators *as3722_regs)
 708 {
 709         struct device_node *np;
 710         struct as3722_regulator_config_data *reg_config;
 711         u32 prop;
 712         int id;
 713         int ret;
 714
 715         np = of_get_child_by_name(pdev->dev.parent->of_node, "regulators");
 716         if (!np) {
 717                 dev_err(&pdev->dev, "Device is not having regulators node\n");
 718                 return -ENODEV;
 719         }
 720         pdev->dev.of_node = np;
 721
 722         ret = of_regulator_match(&pdev->dev, np, as3722_regulator_matches,
 723                         ARRAY_SIZE(as3722_regulator_matches));
 724         of_node_put(np);
 725         if (ret < 0) {
 726                 dev_err(&pdev->dev, "Parsing of regulator node failed: %d\n",
 727                         ret);
 728                 return ret;
 729         }
 730
 731         for (id = 0; id < ARRAY_SIZE(as3722_regulator_matches); ++id) {
 732                 struct device_node *reg_node;
 733
 734                 reg_config = &as3722_regs->reg_config_data[id];
 735                 reg_config->reg_init = as3722_regulator_matches[id].init_data;
 736                 reg_node = as3722_regulator_matches[id].of_node;
 737
 738                 if (!reg_config->reg_init || !reg_node)
 739                         continue;
 740
 741                 ret = of_property_read_u32(reg_node, "ams,ext-control", &prop);
 742                 if (!ret) {
 743                         if (prop < 3)
 744                                 reg_config->ext_control = prop;
 745                         else
 746                                 dev_warn(&pdev->dev,
 747                                         "ext-control have invalid option: %u\n",
 748                                         prop);
 749                 }
 750                 reg_config->enable_tracking =
 751                         of_property_read_bool(reg_node, "ams,enable-tracking");
 752         }
 753         return 0;
 754 }
 755
 756 static int as3722_regulator_probe(struct platform_device *pdev)
 757 {
 758         struct as3722 *as3722 = dev_get_drvdata(pdev->dev.parent);
 759         struct as3722_regulators *as3722_regs;
 760         struct as3722_regulator_config_data *reg_config;
 761         struct regulator_dev *rdev;
 762         struct regulator_config config = { };
 763         struct regulator_ops *ops;
 764         int id;
 765         int ret;
 766
 767         as3722_regs = devm_kzalloc(&pdev->dev, sizeof(*as3722_regs),
 768                                 GFP_KERNEL);
 769         if (!as3722_regs)
 770                 return -ENOMEM;
 771
 772         as3722_regs->dev = &pdev->dev;
 773         as3722_regs->as3722 = as3722;
 774         platform_set_drvdata(pdev, as3722_regs);
 775
 776         ret = as3722_get_regulator_dt_data(pdev, as3722_regs);
 777         if (ret < 0)
 778                 return ret;
 779
 780         config.dev = &pdev->dev;
 781         config.driver_data = as3722_regs;
 782         config.regmap = as3722->regmap;
 783
 784         for (id = 0; id < AS3722_REGULATOR_ID_MAX; id++) {
 785                 reg_config = &as3722_regs->reg_config_data[id];
 786
 787                 as3722_regs->desc[id].name = as3722_reg_lookup[id].name;
 788                 as3722_regs->desc[id].supply_name = as3722_reg_lookup[id].sname;
 789                 as3722_regs->desc[id].id = as3722_reg_lookup[id].regulator_id;
 790                 as3722_regs->desc[id].n_voltages =
 791                                         as3722_reg_lookup[id].n_voltages;
 792                 as3722_regs->desc[id].type = REGULATOR_VOLTAGE;
 793                 as3722_regs->desc[id].owner = THIS_MODULE;
 794                 as3722_regs->desc[id].enable_reg =
 795                                         as3722_reg_lookup[id].enable_reg;
 796                 as3722_regs->desc[id].enable_mask =
 797                                         as3722_reg_lookup[id].enable_mask;
 798                 as3722_regs->desc[id].vsel_reg = as3722_reg_lookup[id].vsel_reg;
 799                 as3722_regs->desc[id].vsel_mask =
 800                                         as3722_reg_lookup[id].vsel_mask;
 801                 switch (id) {
 802                 case AS3722_REGULATOR_ID_LDO0:
 803                         if (reg_config->ext_control)
 804                                 ops = &as3722_ldo0_extcntrl_ops;
 805                         else
 806                                 ops = &as3722_ldo0_ops;
 807                         as3722_regs->desc[id].min_uV = 825000;
 808                         as3722_regs->desc[id].uV_step = 25000;
 809                         as3722_regs->desc[id].linear_min_sel = 1;
 810                         as3722_regs->desc[id].enable_time = 500;
 811                         break;
 812                 case AS3722_REGULATOR_ID_LDO3:
 813                         if (reg_config->ext_control)
 814                                 ops = &as3722_ldo3_extcntrl_ops;
 815                         else
 816                                 ops = &as3722_ldo3_ops;
 817                         as3722_regs->desc[id].min_uV = 620000;
 818                         as3722_regs->desc[id].uV_step = 20000;
 819                         as3722_regs->desc[id].linear_min_sel = 1;
 820                         as3722_regs->desc[id].enable_time = 500;
 821                         if (reg_config->enable_tracking) {
 822                                 ret = as3722_ldo3_set_tracking_mode(as3722_regs,
 823                                         id, AS3722_LDO3_MODE_PMOS_TRACKING);
 824                                 if (ret < 0) {
 825                                         dev_err(&pdev->dev,
 826                                                 "LDO3 tracking failed: %d\n",
 827                                                 ret);
 828                                         return ret;
 829                                 }
 830                         }
 831                         break;
 832                 case AS3722_REGULATOR_ID_SD0:
 833                 case AS3722_REGULATOR_ID_SD1:
 834                 case AS3722_REGULATOR_ID_SD6:
 835                         if (reg_config->ext_control)
 836                                 ops = &as3722_sd016_extcntrl_ops;
 837                         else
 838                                 ops = &as3722_sd016_ops;
 839                         if (id == AS3722_REGULATOR_ID_SD0 &&
 840                             as3722_sd0_is_low_voltage(as3722_regs)) {
 841                                 as3722_regs->desc[id].n_voltages =
 842                                         AS3722_SD0_VSEL_LOW_VOL_MAX + 1;
 843                                 as3722_regs->desc[id].min_uV = 410000;
 844                         } else {
 845                                 as3722_regs->desc[id].n_voltages =
 846                                         AS3722_SD0_VSEL_MAX + 1,
 847                                 as3722_regs->desc[id].min_uV = 610000;
 848                         }
 849                         as3722_regs->desc[id].uV_step = 10000;
 850                         as3722_regs->desc[id].linear_min_sel = 1;
 851                         as3722_regs->desc[id].enable_time = 600;
 852                         break;
 853                 case AS3722_REGULATOR_ID_SD2:
 854                 case AS3722_REGULATOR_ID_SD3:
 855                 case AS3722_REGULATOR_ID_SD4:
 856                 case AS3722_REGULATOR_ID_SD5:
 857                         if (reg_config->ext_control)
 858                                 ops = &as3722_sd2345_extcntrl_ops;
 859                         else
 860                                 ops = &as3722_sd2345_ops;
 861                         as3722_regs->desc[id].linear_ranges =
 862                                                 as3722_sd2345_ranges;
 863                         as3722_regs->desc[id].n_linear_ranges =
 864                                         ARRAY_SIZE(as3722_sd2345_ranges);
 865                         break;
 866                 default:
 867                         if (reg_config->ext_control)
 868                                 ops = &as3722_ldo_extcntrl_ops;
 869                         else
 870                                 ops = &as3722_ldo_ops;
 871                         as3722_regs->desc[id].enable_time = 500;
 872                         as3722_regs->desc[id].linear_ranges = as3722_ldo_ranges;
 873                         as3722_regs->desc[id].n_linear_ranges =
 874                                                 ARRAY_SIZE(as3722_ldo_ranges);
 875                         break;
 876                 }
 877                 as3722_regs->desc[id].ops = ops;
 878                 config.init_data = reg_config->reg_init;
 879                 config.of_node = as3722_regulator_matches[id].of_node;
 880                 rdev = devm_regulator_register(&pdev->dev,
 881                                         &as3722_regs->desc[id], &config);
 882                 if (IS_ERR(rdev)) {
 883                         ret = PTR_ERR(rdev);
 884                         dev_err(&pdev->dev, "regulator %d register failed %d\n",
 885                                 id, ret);
 886                         return ret;
 887                 }
 888
 889                 as3722_regs->rdevs[id] = rdev;
 890                 if (reg_config->ext_control) {
 891                         ret = regulator_enable_regmap(rdev);
 892                         if (ret < 0) {
 893                                 dev_err(&pdev->dev,
 894                                         "Regulator %d enable failed: %d\n",
 895                                         id, ret);
 896                                 return ret;
 897                         }
 898                         ret = as3722_extreg_init(as3722_regs, id,
 899                                         reg_config->ext_control);
 900                         if (ret < 0) {
 901                                 dev_err(&pdev->dev,
 902                                         "AS3722 ext control failed: %d", ret);
 903                                 return ret;
 904                         }
 905                 }
 906         }
 907         return 0;
 908 }
 909
 910 static const struct of_device_id of_as3722_regulator_match[] = {
 911         { .compatible = "ams,as3722-regulator", },
 912         {},
 913 };
 914 MODULE_DEVICE_TABLE(of, of_as3722_regulator_match);
 915
 916 static struct platform_driver as3722_regulator_driver = {
 917         .driver = {
 918                 .name = "as3722-regulator",
 919                 .of_match_table = of_as3722_regulator_match,
 920         },
 921         .probe = as3722_regulator_probe,
 922 };
 923
 924 module_platform_driver(as3722_regulator_driver);
 925
 926 MODULE_ALIAS("platform:as3722-regulator");
 927 MODULE_DESCRIPTION("AS3722 regulator driver");
 928 MODULE_AUTHOR("Florian Lobmaier <florian.lobmaier@ams.com>");
 929 MODULE_AUTHOR("Laxman Dewangan <ldewangan@nvidia.com>");
 930 MODULE_LICENSE("GPL");