linux/drivers/regulator/rk808-regulator.c
<<
>>
Prefs
   1/*
   2 * Regulator driver for Rockchip RK808
   3 *
   4 * Copyright (c) 2014, Fuzhou Rockchip Electronics Co., Ltd
   5 *
   6 * Author: Chris Zhong <zyw@rock-chips.com>
   7 * Author: Zhang Qing <zhangqing@rock-chips.com>
   8 *
   9 * This program is free software; you can redistribute it and/or modify it
  10 * under the terms and conditions of the GNU General Public License,
  11 * version 2, as published by the Free Software Foundation.
  12 *
  13 * This program is distributed in the hope it will be useful, but WITHOUT
  14 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  15 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  16 * more details.
  17 */
  18
  19#include <linux/delay.h>
  20#include <linux/gpio.h>
  21#include <linux/i2c.h>
  22#include <linux/module.h>
  23#include <linux/of_device.h>
  24#include <linux/of_gpio.h>
  25#include <linux/mfd/rk808.h>
  26#include <linux/regulator/driver.h>
  27#include <linux/regulator/of_regulator.h>
  28#include <linux/gpio/consumer.h>
  29
  30/* Field Definitions */
  31#define RK808_BUCK_VSEL_MASK    0x3f
  32#define RK808_BUCK4_VSEL_MASK   0xf
  33#define RK808_LDO_VSEL_MASK     0x1f
  34
  35/* Ramp rate definitions for buck1 / buck2 only */
  36#define RK808_RAMP_RATE_OFFSET          3
  37#define RK808_RAMP_RATE_MASK            (3 << RK808_RAMP_RATE_OFFSET)
  38#define RK808_RAMP_RATE_2MV_PER_US      (0 << RK808_RAMP_RATE_OFFSET)
  39#define RK808_RAMP_RATE_4MV_PER_US      (1 << RK808_RAMP_RATE_OFFSET)
  40#define RK808_RAMP_RATE_6MV_PER_US      (2 << RK808_RAMP_RATE_OFFSET)
  41#define RK808_RAMP_RATE_10MV_PER_US     (3 << RK808_RAMP_RATE_OFFSET)
  42
  43#define RK808_DVS2_POL          BIT(2)
  44#define RK808_DVS1_POL          BIT(1)
  45
  46/* Offset from XXX_ON_VSEL to XXX_SLP_VSEL */
  47#define RK808_SLP_REG_OFFSET 1
  48
  49/* Offset from XXX_ON_VSEL to XXX_DVS_VSEL */
  50#define RK808_DVS_REG_OFFSET 2
  51
  52/* Offset from XXX_EN_REG to SLEEP_SET_OFF_XXX */
  53#define RK808_SLP_SET_OFF_REG_OFFSET 2
  54
  55/* max steps for increase voltage of Buck1/2, equal 100mv*/
  56#define MAX_STEPS_ONE_TIME 8
  57
  58struct rk808_regulator_data {
  59        struct gpio_desc *dvs_gpio[2];
  60};
  61
  62static const int rk808_buck_config_regs[] = {
  63        RK808_BUCK1_CONFIG_REG,
  64        RK808_BUCK2_CONFIG_REG,
  65        RK808_BUCK3_CONFIG_REG,
  66        RK808_BUCK4_CONFIG_REG,
  67};
  68
  69static const struct regulator_linear_range rk808_buck_voltage_ranges[] = {
  70        REGULATOR_LINEAR_RANGE(712500, 0, 63, 12500),
  71};
  72
  73static const struct regulator_linear_range rk808_buck4_voltage_ranges[] = {
  74        REGULATOR_LINEAR_RANGE(1800000, 0, 15, 100000),
  75};
  76
  77static const struct regulator_linear_range rk808_ldo_voltage_ranges[] = {
  78        REGULATOR_LINEAR_RANGE(1800000, 0, 16, 100000),
  79};
  80
  81static const struct regulator_linear_range rk808_ldo3_voltage_ranges[] = {
  82        REGULATOR_LINEAR_RANGE(800000, 0, 13, 100000),
  83        REGULATOR_LINEAR_RANGE(2500000, 15, 15, 0),
  84};
  85
  86static const struct regulator_linear_range rk808_ldo6_voltage_ranges[] = {
  87        REGULATOR_LINEAR_RANGE(800000, 0, 17, 100000),
  88};
  89
  90static int rk808_buck1_2_get_voltage_sel_regmap(struct regulator_dev *rdev)
  91{
  92        struct rk808_regulator_data *pdata = rdev_get_drvdata(rdev);
  93        int id = rdev->desc->id - RK808_ID_DCDC1;
  94        struct gpio_desc *gpio = pdata->dvs_gpio[id];
  95        unsigned int val;
  96        int ret;
  97
  98        if (!gpio || gpiod_get_value(gpio) == 0)
  99                return regulator_get_voltage_sel_regmap(rdev);
 100
 101        ret = regmap_read(rdev->regmap,
 102                          rdev->desc->vsel_reg + RK808_DVS_REG_OFFSET,
 103                          &val);
 104        if (ret != 0)
 105                return ret;
 106
 107        val &= rdev->desc->vsel_mask;
 108        val >>= ffs(rdev->desc->vsel_mask) - 1;
 109
 110        return val;
 111}
 112
 113static int rk808_buck1_2_i2c_set_voltage_sel(struct regulator_dev *rdev,
 114                                             unsigned sel)
 115{
 116        int ret, delta_sel;
 117        unsigned int old_sel, tmp, val, mask = rdev->desc->vsel_mask;
 118
 119        ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
 120        if (ret != 0)
 121                return ret;
 122
 123        tmp = val & ~mask;
 124        old_sel = val & mask;
 125        old_sel >>= ffs(mask) - 1;
 126        delta_sel = sel - old_sel;
 127
 128        /*
 129         * If directly modify the register to change the voltage, we will face
 130         * the risk of overshoot. Put it into a multi-step, can effectively
 131         * avoid this problem, a step is 100mv here.
 132         */
 133        while (delta_sel > MAX_STEPS_ONE_TIME) {
 134                old_sel += MAX_STEPS_ONE_TIME;
 135                val = old_sel << (ffs(mask) - 1);
 136                val |= tmp;
 137
 138                /*
 139                 * i2c is 400kHz (2.5us per bit) and we must transmit _at least_
 140                 * 3 bytes (24 bits) plus start and stop so 26 bits.  So we've
 141                 * got more than 65 us between each voltage change and thus
 142                 * won't ramp faster than ~1500 uV / us.
 143                 */
 144                ret = regmap_write(rdev->regmap, rdev->desc->vsel_reg, val);
 145                delta_sel = sel - old_sel;
 146        }
 147
 148        sel <<= ffs(mask) - 1;
 149        val = tmp | sel;
 150        ret = regmap_write(rdev->regmap, rdev->desc->vsel_reg, val);
 151
 152        /*
 153         * When we change the voltage register directly, the ramp rate is about
 154         * 100000uv/us, wait 1us to make sure the target voltage to be stable,
 155         * so we needn't wait extra time after that.
 156         */
 157        udelay(1);
 158
 159        return ret;
 160}
 161
 162static int rk808_buck1_2_set_voltage_sel(struct regulator_dev *rdev,
 163                                         unsigned sel)
 164{
 165        struct rk808_regulator_data *pdata = rdev_get_drvdata(rdev);
 166        int id = rdev->desc->id - RK808_ID_DCDC1;
 167        struct gpio_desc *gpio = pdata->dvs_gpio[id];
 168        unsigned int reg = rdev->desc->vsel_reg;
 169        unsigned old_sel;
 170        int ret, gpio_level;
 171
 172        if (!gpio)
 173                return rk808_buck1_2_i2c_set_voltage_sel(rdev, sel);
 174
 175        gpio_level = gpiod_get_value(gpio);
 176        if (gpio_level == 0) {
 177                reg += RK808_DVS_REG_OFFSET;
 178                ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &old_sel);
 179        } else {
 180                ret = regmap_read(rdev->regmap,
 181                                  reg + RK808_DVS_REG_OFFSET,
 182                                  &old_sel);
 183        }
 184
 185        if (ret != 0)
 186                return ret;
 187
 188        sel <<= ffs(rdev->desc->vsel_mask) - 1;
 189        sel |= old_sel & ~rdev->desc->vsel_mask;
 190
 191        ret = regmap_write(rdev->regmap, reg, sel);
 192        if (ret)
 193                return ret;
 194
 195        gpiod_set_value(gpio, !gpio_level);
 196
 197        return ret;
 198}
 199
 200static int rk808_buck1_2_set_voltage_time_sel(struct regulator_dev *rdev,
 201                                       unsigned int old_selector,
 202                                       unsigned int new_selector)
 203{
 204        struct rk808_regulator_data *pdata = rdev_get_drvdata(rdev);
 205        int id = rdev->desc->id - RK808_ID_DCDC1;
 206        struct gpio_desc *gpio = pdata->dvs_gpio[id];
 207
 208        /* if there is no dvs1/2 pin, we don't need wait extra time here. */
 209        if (!gpio)
 210                return 0;
 211
 212        return regulator_set_voltage_time_sel(rdev, old_selector, new_selector);
 213}
 214
 215static int rk808_set_ramp_delay(struct regulator_dev *rdev, int ramp_delay)
 216{
 217        unsigned int ramp_value = RK808_RAMP_RATE_10MV_PER_US;
 218        unsigned int reg = rk808_buck_config_regs[rdev->desc->id -
 219                                                  RK808_ID_DCDC1];
 220
 221        switch (ramp_delay) {
 222        case 1 ... 2000:
 223                ramp_value = RK808_RAMP_RATE_2MV_PER_US;
 224                break;
 225        case 2001 ... 4000:
 226                ramp_value = RK808_RAMP_RATE_4MV_PER_US;
 227                break;
 228        case 4001 ... 6000:
 229                ramp_value = RK808_RAMP_RATE_6MV_PER_US;
 230                break;
 231        case 6001 ... 10000:
 232                break;
 233        default:
 234                pr_warn("%s ramp_delay: %d not supported, setting 10000\n",
 235                        rdev->desc->name, ramp_delay);
 236        }
 237
 238        return regmap_update_bits(rdev->regmap, reg,
 239                                  RK808_RAMP_RATE_MASK, ramp_value);
 240}
 241
 242static int rk808_set_suspend_voltage(struct regulator_dev *rdev, int uv)
 243{
 244        unsigned int reg;
 245        int sel = regulator_map_voltage_linear_range(rdev, uv, uv);
 246
 247        if (sel < 0)
 248                return -EINVAL;
 249
 250        reg = rdev->desc->vsel_reg + RK808_SLP_REG_OFFSET;
 251
 252        return regmap_update_bits(rdev->regmap, reg,
 253                                  rdev->desc->vsel_mask,
 254                                  sel);
 255}
 256
 257static int rk808_set_suspend_enable(struct regulator_dev *rdev)
 258{
 259        unsigned int reg;
 260
 261        reg = rdev->desc->enable_reg + RK808_SLP_SET_OFF_REG_OFFSET;
 262
 263        return regmap_update_bits(rdev->regmap, reg,
 264                                  rdev->desc->enable_mask,
 265                                  0);
 266}
 267
 268static int rk808_set_suspend_disable(struct regulator_dev *rdev)
 269{
 270        unsigned int reg;
 271
 272        reg = rdev->desc->enable_reg + RK808_SLP_SET_OFF_REG_OFFSET;
 273
 274        return regmap_update_bits(rdev->regmap, reg,
 275                                  rdev->desc->enable_mask,
 276                                  rdev->desc->enable_mask);
 277}
 278
 279static struct regulator_ops rk808_buck1_2_ops = {
 280        .list_voltage           = regulator_list_voltage_linear_range,
 281        .map_voltage            = regulator_map_voltage_linear_range,
 282        .get_voltage_sel        = rk808_buck1_2_get_voltage_sel_regmap,
 283        .set_voltage_sel        = rk808_buck1_2_set_voltage_sel,
 284        .set_voltage_time_sel   = rk808_buck1_2_set_voltage_time_sel,
 285        .enable                 = regulator_enable_regmap,
 286        .disable                = regulator_disable_regmap,
 287        .is_enabled             = regulator_is_enabled_regmap,
 288        .set_ramp_delay         = rk808_set_ramp_delay,
 289        .set_suspend_voltage    = rk808_set_suspend_voltage,
 290        .set_suspend_enable     = rk808_set_suspend_enable,
 291        .set_suspend_disable    = rk808_set_suspend_disable,
 292};
 293
 294static struct regulator_ops rk808_reg_ops = {
 295        .list_voltage           = regulator_list_voltage_linear_range,
 296        .map_voltage            = regulator_map_voltage_linear_range,
 297        .get_voltage_sel        = regulator_get_voltage_sel_regmap,
 298        .set_voltage_sel        = regulator_set_voltage_sel_regmap,
 299        .enable                 = regulator_enable_regmap,
 300        .disable                = regulator_disable_regmap,
 301        .is_enabled             = regulator_is_enabled_regmap,
 302        .set_suspend_voltage    = rk808_set_suspend_voltage,
 303        .set_suspend_enable     = rk808_set_suspend_enable,
 304        .set_suspend_disable    = rk808_set_suspend_disable,
 305};
 306
 307static struct regulator_ops rk808_switch_ops = {
 308        .enable                 = regulator_enable_regmap,
 309        .disable                = regulator_disable_regmap,
 310        .is_enabled             = regulator_is_enabled_regmap,
 311        .set_suspend_enable     = rk808_set_suspend_enable,
 312        .set_suspend_disable    = rk808_set_suspend_disable,
 313};
 314
 315static const struct regulator_desc rk808_reg[] = {
 316        {
 317                .name = "DCDC_REG1",
 318                .supply_name = "vcc1",
 319                .id = RK808_ID_DCDC1,
 320                .ops = &rk808_buck1_2_ops,
 321                .type = REGULATOR_VOLTAGE,
 322                .n_voltages = 64,
 323                .linear_ranges = rk808_buck_voltage_ranges,
 324                .n_linear_ranges = ARRAY_SIZE(rk808_buck_voltage_ranges),
 325                .vsel_reg = RK808_BUCK1_ON_VSEL_REG,
 326                .vsel_mask = RK808_BUCK_VSEL_MASK,
 327                .enable_reg = RK808_DCDC_EN_REG,
 328                .enable_mask = BIT(0),
 329                .owner = THIS_MODULE,
 330        }, {
 331                .name = "DCDC_REG2",
 332                .supply_name = "vcc2",
 333                .id = RK808_ID_DCDC2,
 334                .ops = &rk808_buck1_2_ops,
 335                .type = REGULATOR_VOLTAGE,
 336                .n_voltages = 64,
 337                .linear_ranges = rk808_buck_voltage_ranges,
 338                .n_linear_ranges = ARRAY_SIZE(rk808_buck_voltage_ranges),
 339                .vsel_reg = RK808_BUCK2_ON_VSEL_REG,
 340                .vsel_mask = RK808_BUCK_VSEL_MASK,
 341                .enable_reg = RK808_DCDC_EN_REG,
 342                .enable_mask = BIT(1),
 343                .owner = THIS_MODULE,
 344        }, {
 345                .name = "DCDC_REG3",
 346                .supply_name = "vcc3",
 347                .id = RK808_ID_DCDC3,
 348                .ops = &rk808_switch_ops,
 349                .type = REGULATOR_VOLTAGE,
 350                .n_voltages = 1,
 351                .enable_reg = RK808_DCDC_EN_REG,
 352                .enable_mask = BIT(2),
 353                .owner = THIS_MODULE,
 354        }, {
 355                .name = "DCDC_REG4",
 356                .supply_name = "vcc4",
 357                .id = RK808_ID_DCDC4,
 358                .ops = &rk808_reg_ops,
 359                .type = REGULATOR_VOLTAGE,
 360                .n_voltages = 16,
 361                .linear_ranges = rk808_buck4_voltage_ranges,
 362                .n_linear_ranges = ARRAY_SIZE(rk808_buck4_voltage_ranges),
 363                .vsel_reg = RK808_BUCK4_ON_VSEL_REG,
 364                .vsel_mask = RK808_BUCK4_VSEL_MASK,
 365                .enable_reg = RK808_DCDC_EN_REG,
 366                .enable_mask = BIT(3),
 367                .owner = THIS_MODULE,
 368        }, {
 369                .name = "LDO_REG1",
 370                .supply_name = "vcc6",
 371                .id = RK808_ID_LDO1,
 372                .ops = &rk808_reg_ops,
 373                .type = REGULATOR_VOLTAGE,
 374                .n_voltages = 17,
 375                .linear_ranges = rk808_ldo_voltage_ranges,
 376                .n_linear_ranges = ARRAY_SIZE(rk808_ldo_voltage_ranges),
 377                .vsel_reg = RK808_LDO1_ON_VSEL_REG,
 378                .vsel_mask = RK808_LDO_VSEL_MASK,
 379                .enable_reg = RK808_LDO_EN_REG,
 380                .enable_mask = BIT(0),
 381                .enable_time = 400,
 382                .owner = THIS_MODULE,
 383        }, {
 384                .name = "LDO_REG2",
 385                .supply_name = "vcc6",
 386                .id = RK808_ID_LDO2,
 387                .ops = &rk808_reg_ops,
 388                .type = REGULATOR_VOLTAGE,
 389                .n_voltages = 17,
 390                .linear_ranges = rk808_ldo_voltage_ranges,
 391                .n_linear_ranges = ARRAY_SIZE(rk808_ldo_voltage_ranges),
 392                .vsel_reg = RK808_LDO2_ON_VSEL_REG,
 393                .vsel_mask = RK808_LDO_VSEL_MASK,
 394                .enable_reg = RK808_LDO_EN_REG,
 395                .enable_mask = BIT(1),
 396                .enable_time = 400,
 397                .owner = THIS_MODULE,
 398        }, {
 399                .name = "LDO_REG3",
 400                .supply_name = "vcc7",
 401                .id = RK808_ID_LDO3,
 402                .ops = &rk808_reg_ops,
 403                .type = REGULATOR_VOLTAGE,
 404                .n_voltages = 16,
 405                .linear_ranges = rk808_ldo3_voltage_ranges,
 406                .n_linear_ranges = ARRAY_SIZE(rk808_ldo3_voltage_ranges),
 407                .vsel_reg = RK808_LDO3_ON_VSEL_REG,
 408                .vsel_mask = RK808_BUCK4_VSEL_MASK,
 409                .enable_reg = RK808_LDO_EN_REG,
 410                .enable_mask = BIT(2),
 411                .enable_time = 400,
 412                .owner = THIS_MODULE,
 413        }, {
 414                .name = "LDO_REG4",
 415                .supply_name = "vcc9",
 416                .id = RK808_ID_LDO4,
 417                .ops = &rk808_reg_ops,
 418                .type = REGULATOR_VOLTAGE,
 419                .n_voltages = 17,
 420                .linear_ranges = rk808_ldo_voltage_ranges,
 421                .n_linear_ranges = ARRAY_SIZE(rk808_ldo_voltage_ranges),
 422                .vsel_reg = RK808_LDO4_ON_VSEL_REG,
 423                .vsel_mask = RK808_LDO_VSEL_MASK,
 424                .enable_reg = RK808_LDO_EN_REG,
 425                .enable_mask = BIT(3),
 426                .enable_time = 400,
 427                .owner = THIS_MODULE,
 428        }, {
 429                .name = "LDO_REG5",
 430                .supply_name = "vcc9",
 431                .id = RK808_ID_LDO5,
 432                .ops = &rk808_reg_ops,
 433                .type = REGULATOR_VOLTAGE,
 434                .n_voltages = 17,
 435                .linear_ranges = rk808_ldo_voltage_ranges,
 436                .n_linear_ranges = ARRAY_SIZE(rk808_ldo_voltage_ranges),
 437                .vsel_reg = RK808_LDO5_ON_VSEL_REG,
 438                .vsel_mask = RK808_LDO_VSEL_MASK,
 439                .enable_reg = RK808_LDO_EN_REG,
 440                .enable_mask = BIT(4),
 441                .enable_time = 400,
 442                .owner = THIS_MODULE,
 443        }, {
 444                .name = "LDO_REG6",
 445                .supply_name = "vcc10",
 446                .id = RK808_ID_LDO6,
 447                .ops = &rk808_reg_ops,
 448                .type = REGULATOR_VOLTAGE,
 449                .n_voltages = 18,
 450                .linear_ranges = rk808_ldo6_voltage_ranges,
 451                .n_linear_ranges = ARRAY_SIZE(rk808_ldo6_voltage_ranges),
 452                .vsel_reg = RK808_LDO6_ON_VSEL_REG,
 453                .vsel_mask = RK808_LDO_VSEL_MASK,
 454                .enable_reg = RK808_LDO_EN_REG,
 455                .enable_mask = BIT(5),
 456                .enable_time = 400,
 457                .owner = THIS_MODULE,
 458        }, {
 459                .name = "LDO_REG7",
 460                .supply_name = "vcc7",
 461                .id = RK808_ID_LDO7,
 462                .ops = &rk808_reg_ops,
 463                .type = REGULATOR_VOLTAGE,
 464                .n_voltages = 18,
 465                .linear_ranges = rk808_ldo6_voltage_ranges,
 466                .n_linear_ranges = ARRAY_SIZE(rk808_ldo6_voltage_ranges),
 467                .vsel_reg = RK808_LDO7_ON_VSEL_REG,
 468                .vsel_mask = RK808_LDO_VSEL_MASK,
 469                .enable_reg = RK808_LDO_EN_REG,
 470                .enable_mask = BIT(6),
 471                .enable_time = 400,
 472                .owner = THIS_MODULE,
 473        }, {
 474                .name = "LDO_REG8",
 475                .supply_name = "vcc11",
 476                .id = RK808_ID_LDO8,
 477                .ops = &rk808_reg_ops,
 478                .type = REGULATOR_VOLTAGE,
 479                .n_voltages = 17,
 480                .linear_ranges = rk808_ldo_voltage_ranges,
 481                .n_linear_ranges = ARRAY_SIZE(rk808_ldo_voltage_ranges),
 482                .vsel_reg = RK808_LDO8_ON_VSEL_REG,
 483                .vsel_mask = RK808_LDO_VSEL_MASK,
 484                .enable_reg = RK808_LDO_EN_REG,
 485                .enable_mask = BIT(7),
 486                .enable_time = 400,
 487                .owner = THIS_MODULE,
 488        }, {
 489                .name = "SWITCH_REG1",
 490                .supply_name = "vcc8",
 491                .id = RK808_ID_SWITCH1,
 492                .ops = &rk808_switch_ops,
 493                .type = REGULATOR_VOLTAGE,
 494                .enable_reg = RK808_DCDC_EN_REG,
 495                .enable_mask = BIT(5),
 496                .owner = THIS_MODULE,
 497        }, {
 498                .name = "SWITCH_REG2",
 499                .supply_name = "vcc12",
 500                .id = RK808_ID_SWITCH2,
 501                .ops = &rk808_switch_ops,
 502                .type = REGULATOR_VOLTAGE,
 503                .enable_reg = RK808_DCDC_EN_REG,
 504                .enable_mask = BIT(6),
 505                .owner = THIS_MODULE,
 506        },
 507};
 508
 509static struct of_regulator_match rk808_reg_matches[] = {
 510        [RK808_ID_DCDC1]        = { .name = "DCDC_REG1" },
 511        [RK808_ID_DCDC2]        = { .name = "DCDC_REG2" },
 512        [RK808_ID_DCDC3]        = { .name = "DCDC_REG3" },
 513        [RK808_ID_DCDC4]        = { .name = "DCDC_REG4" },
 514        [RK808_ID_LDO1]         = { .name = "LDO_REG1" },
 515        [RK808_ID_LDO2]         = { .name = "LDO_REG2" },
 516        [RK808_ID_LDO3]         = { .name = "LDO_REG3" },
 517        [RK808_ID_LDO4]         = { .name = "LDO_REG4" },
 518        [RK808_ID_LDO5]         = { .name = "LDO_REG5" },
 519        [RK808_ID_LDO6]         = { .name = "LDO_REG6" },
 520        [RK808_ID_LDO7]         = { .name = "LDO_REG7" },
 521        [RK808_ID_LDO8]         = { .name = "LDO_REG8" },
 522        [RK808_ID_SWITCH1]      = { .name = "SWITCH_REG1" },
 523        [RK808_ID_SWITCH2]      = { .name = "SWITCH_REG2" },
 524};
 525
 526static int rk808_regulator_dt_parse_pdata(struct device *dev,
 527                                   struct device *client_dev,
 528                                   struct regmap *map,
 529                                   struct rk808_regulator_data *pdata)
 530{
 531        struct device_node *np;
 532        int tmp, ret, i;
 533
 534        np = of_get_child_by_name(client_dev->of_node, "regulators");
 535        if (!np)
 536                return -ENXIO;
 537
 538        ret = of_regulator_match(dev, np, rk808_reg_matches,
 539                                 RK808_NUM_REGULATORS);
 540        if (ret < 0)
 541                goto dt_parse_end;
 542
 543        for (i = 0; i < ARRAY_SIZE(pdata->dvs_gpio); i++) {
 544                pdata->dvs_gpio[i] =
 545                        devm_gpiod_get_index_optional(client_dev, "dvs", i,
 546                                                      GPIOD_OUT_LOW);
 547                if (IS_ERR(pdata->dvs_gpio[i])) {
 548                        ret = PTR_ERR(pdata->dvs_gpio[i]);
 549                        dev_err(dev, "failed to get dvs%d gpio (%d)\n", i, ret);
 550                        goto dt_parse_end;
 551                }
 552
 553                if (!pdata->dvs_gpio[i]) {
 554                        dev_warn(dev, "there is no dvs%d gpio\n", i);
 555                        continue;
 556                }
 557
 558                tmp = i ? RK808_DVS2_POL : RK808_DVS1_POL;
 559                ret = regmap_update_bits(map, RK808_IO_POL_REG, tmp,
 560                                gpiod_is_active_low(pdata->dvs_gpio[i]) ?
 561                                0 : tmp);
 562        }
 563
 564dt_parse_end:
 565        of_node_put(np);
 566        return ret;
 567}
 568
 569static int rk808_regulator_probe(struct platform_device *pdev)
 570{
 571        struct rk808 *rk808 = dev_get_drvdata(pdev->dev.parent);
 572        struct i2c_client *client = rk808->i2c;
 573        struct regulator_config config = {};
 574        struct regulator_dev *rk808_rdev;
 575        struct rk808_regulator_data *pdata;
 576        int ret, i;
 577
 578        pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
 579        if (!pdata)
 580                return -ENOMEM;
 581
 582        ret = rk808_regulator_dt_parse_pdata(&pdev->dev, &client->dev,
 583                                             rk808->regmap, pdata);
 584        if (ret < 0)
 585                return ret;
 586
 587        platform_set_drvdata(pdev, pdata);
 588
 589        /* Instantiate the regulators */
 590        for (i = 0; i < RK808_NUM_REGULATORS; i++) {
 591                if (!rk808_reg_matches[i].init_data ||
 592                    !rk808_reg_matches[i].of_node)
 593                        continue;
 594
 595                config.dev = &client->dev;
 596                config.driver_data = pdata;
 597                config.regmap = rk808->regmap;
 598                config.of_node = rk808_reg_matches[i].of_node;
 599                config.init_data = rk808_reg_matches[i].init_data;
 600
 601                rk808_rdev = devm_regulator_register(&pdev->dev,
 602                                                     &rk808_reg[i], &config);
 603                if (IS_ERR(rk808_rdev)) {
 604                        dev_err(&client->dev,
 605                                "failed to register %d regulator\n", i);
 606                        return PTR_ERR(rk808_rdev);
 607                }
 608        }
 609
 610        return 0;
 611}
 612
 613static struct platform_driver rk808_regulator_driver = {
 614        .probe = rk808_regulator_probe,
 615        .driver = {
 616                .name = "rk808-regulator",
 617                .owner = THIS_MODULE,
 618        },
 619};
 620
 621module_platform_driver(rk808_regulator_driver);
 622
 623MODULE_DESCRIPTION("regulator driver for the rk808 series PMICs");
 624MODULE_AUTHOR("Chris Zhong<zyw@rock-chips.com>");
 625MODULE_AUTHOR("Zhang Qing<zhangqing@rock-chips.com>");
 626MODULE_LICENSE("GPL");
 627MODULE_ALIAS("platform:rk808-regulator");
 628