Linux Audio

Check our new training course

Loading...
Note: File does not exist in v3.1.
   1// SPDX-License-Identifier: GPL-2.0+
   2//
   3// Copyright (c) 2011 Samsung Electronics Co., Ltd
   4//              http://www.samsung.com
   5
   6#include <linux/err.h>
   7#include <linux/of_gpio.h>
   8#include <linux/gpio/consumer.h>
   9#include <linux/module.h>
  10#include <linux/platform_device.h>
  11#include <linux/regulator/driver.h>
  12#include <linux/regulator/machine.h>
  13#include <linux/mfd/samsung/core.h>
  14#include <linux/mfd/samsung/s5m8767.h>
  15#include <linux/regulator/of_regulator.h>
  16#include <linux/regmap.h>
  17
  18#define S5M8767_OPMODE_NORMAL_MODE 0x1
  19
  20struct s5m8767_info {
  21	struct device *dev;
  22	struct sec_pmic_dev *iodev;
  23	int num_regulators;
  24	struct sec_opmode_data *opmode;
  25
  26	int ramp_delay;
  27	bool buck2_ramp;
  28	bool buck3_ramp;
  29	bool buck4_ramp;
  30
  31	bool buck2_gpiodvs;
  32	bool buck3_gpiodvs;
  33	bool buck4_gpiodvs;
  34	u8 buck2_vol[8];
  35	u8 buck3_vol[8];
  36	u8 buck4_vol[8];
  37	int buck_gpios[3];
  38	int buck_ds[3];
  39	int buck_gpioindex;
  40};
  41
  42struct sec_voltage_desc {
  43	int max;
  44	int min;
  45	int step;
  46};
  47
  48static const struct sec_voltage_desc buck_voltage_val1 = {
  49	.max = 2225000,
  50	.min =  650000,
  51	.step =   6250,
  52};
  53
  54static const struct sec_voltage_desc buck_voltage_val2 = {
  55	.max = 1600000,
  56	.min =  600000,
  57	.step =   6250,
  58};
  59
  60static const struct sec_voltage_desc buck_voltage_val3 = {
  61	.max = 3000000,
  62	.min =  750000,
  63	.step =  12500,
  64};
  65
  66static const struct sec_voltage_desc ldo_voltage_val1 = {
  67	.max = 3950000,
  68	.min =  800000,
  69	.step =  50000,
  70};
  71
  72static const struct sec_voltage_desc ldo_voltage_val2 = {
  73	.max = 2375000,
  74	.min =  800000,
  75	.step =  25000,
  76};
  77
  78static const struct sec_voltage_desc *reg_voltage_map[] = {
  79	[S5M8767_LDO1] = &ldo_voltage_val2,
  80	[S5M8767_LDO2] = &ldo_voltage_val2,
  81	[S5M8767_LDO3] = &ldo_voltage_val1,
  82	[S5M8767_LDO4] = &ldo_voltage_val1,
  83	[S5M8767_LDO5] = &ldo_voltage_val1,
  84	[S5M8767_LDO6] = &ldo_voltage_val2,
  85	[S5M8767_LDO7] = &ldo_voltage_val2,
  86	[S5M8767_LDO8] = &ldo_voltage_val2,
  87	[S5M8767_LDO9] = &ldo_voltage_val1,
  88	[S5M8767_LDO10] = &ldo_voltage_val1,
  89	[S5M8767_LDO11] = &ldo_voltage_val1,
  90	[S5M8767_LDO12] = &ldo_voltage_val1,
  91	[S5M8767_LDO13] = &ldo_voltage_val1,
  92	[S5M8767_LDO14] = &ldo_voltage_val1,
  93	[S5M8767_LDO15] = &ldo_voltage_val2,
  94	[S5M8767_LDO16] = &ldo_voltage_val1,
  95	[S5M8767_LDO17] = &ldo_voltage_val1,
  96	[S5M8767_LDO18] = &ldo_voltage_val1,
  97	[S5M8767_LDO19] = &ldo_voltage_val1,
  98	[S5M8767_LDO20] = &ldo_voltage_val1,
  99	[S5M8767_LDO21] = &ldo_voltage_val1,
 100	[S5M8767_LDO22] = &ldo_voltage_val1,
 101	[S5M8767_LDO23] = &ldo_voltage_val1,
 102	[S5M8767_LDO24] = &ldo_voltage_val1,
 103	[S5M8767_LDO25] = &ldo_voltage_val1,
 104	[S5M8767_LDO26] = &ldo_voltage_val1,
 105	[S5M8767_LDO27] = &ldo_voltage_val1,
 106	[S5M8767_LDO28] = &ldo_voltage_val1,
 107	[S5M8767_BUCK1] = &buck_voltage_val1,
 108	[S5M8767_BUCK2] = &buck_voltage_val2,
 109	[S5M8767_BUCK3] = &buck_voltage_val2,
 110	[S5M8767_BUCK4] = &buck_voltage_val2,
 111	[S5M8767_BUCK5] = &buck_voltage_val1,
 112	[S5M8767_BUCK6] = &buck_voltage_val1,
 113	[S5M8767_BUCK7] = &buck_voltage_val3,
 114	[S5M8767_BUCK8] = &buck_voltage_val3,
 115	[S5M8767_BUCK9] = &buck_voltage_val3,
 116};
 117
 118static const unsigned int s5m8767_opmode_reg[][4] = {
 119	/* {OFF, ON, LOWPOWER, SUSPEND} */
 120	/* LDO1 ... LDO28 */
 121	{0x0, 0x3, 0x2, 0x1}, /* LDO1 */
 122	{0x0, 0x3, 0x2, 0x1},
 123	{0x0, 0x3, 0x2, 0x1},
 124	{0x0, 0x0, 0x0, 0x0},
 125	{0x0, 0x3, 0x2, 0x1}, /* LDO5 */
 126	{0x0, 0x3, 0x2, 0x1},
 127	{0x0, 0x3, 0x2, 0x1},
 128	{0x0, 0x3, 0x2, 0x1},
 129	{0x0, 0x3, 0x2, 0x1},
 130	{0x0, 0x3, 0x2, 0x1}, /* LDO10 */
 131	{0x0, 0x3, 0x2, 0x1},
 132	{0x0, 0x3, 0x2, 0x1},
 133	{0x0, 0x3, 0x2, 0x1},
 134	{0x0, 0x3, 0x2, 0x1},
 135	{0x0, 0x3, 0x2, 0x1}, /* LDO15 */
 136	{0x0, 0x3, 0x2, 0x1},
 137	{0x0, 0x3, 0x2, 0x1},
 138	{0x0, 0x0, 0x0, 0x0},
 139	{0x0, 0x3, 0x2, 0x1},
 140	{0x0, 0x3, 0x2, 0x1}, /* LDO20 */
 141	{0x0, 0x3, 0x2, 0x1},
 142	{0x0, 0x3, 0x2, 0x1},
 143	{0x0, 0x0, 0x0, 0x0},
 144	{0x0, 0x3, 0x2, 0x1},
 145	{0x0, 0x3, 0x2, 0x1}, /* LDO25 */
 146	{0x0, 0x3, 0x2, 0x1},
 147	{0x0, 0x3, 0x2, 0x1},
 148	{0x0, 0x3, 0x2, 0x1}, /* LDO28 */
 149
 150	/* BUCK1 ... BUCK9 */
 151	{0x0, 0x3, 0x1, 0x1}, /* BUCK1 */
 152	{0x0, 0x3, 0x1, 0x1},
 153	{0x0, 0x3, 0x1, 0x1},
 154	{0x0, 0x3, 0x1, 0x1},
 155	{0x0, 0x3, 0x2, 0x1}, /* BUCK5 */
 156	{0x0, 0x3, 0x1, 0x1},
 157	{0x0, 0x3, 0x1, 0x1},
 158	{0x0, 0x3, 0x1, 0x1},
 159	{0x0, 0x3, 0x1, 0x1}, /* BUCK9 */
 160};
 161
 162static int s5m8767_get_register(struct s5m8767_info *s5m8767, int reg_id,
 163				int *reg, int *enable_ctrl)
 164{
 165	int i;
 166	unsigned int mode;
 167
 168	switch (reg_id) {
 169	case S5M8767_LDO1 ... S5M8767_LDO2:
 170		*reg = S5M8767_REG_LDO1CTRL + (reg_id - S5M8767_LDO1);
 171		break;
 172	case S5M8767_LDO3 ... S5M8767_LDO28:
 173		*reg = S5M8767_REG_LDO3CTRL + (reg_id - S5M8767_LDO3);
 174		break;
 175	case S5M8767_BUCK1:
 176		*reg = S5M8767_REG_BUCK1CTRL1;
 177		break;
 178	case S5M8767_BUCK2 ... S5M8767_BUCK4:
 179		*reg = S5M8767_REG_BUCK2CTRL + (reg_id - S5M8767_BUCK2) * 9;
 180		break;
 181	case S5M8767_BUCK5:
 182		*reg = S5M8767_REG_BUCK5CTRL1;
 183		break;
 184	case S5M8767_BUCK6 ... S5M8767_BUCK9:
 185		*reg = S5M8767_REG_BUCK6CTRL1 + (reg_id - S5M8767_BUCK6) * 2;
 186		break;
 187	default:
 188		return -EINVAL;
 189	}
 190
 191	for (i = 0; i < s5m8767->num_regulators; i++) {
 192		if (s5m8767->opmode[i].id == reg_id) {
 193			mode = s5m8767->opmode[i].mode;
 194			break;
 195		}
 196	}
 197
 198	if (i >= s5m8767->num_regulators)
 199		return -EINVAL;
 200
 201	*enable_ctrl = s5m8767_opmode_reg[reg_id][mode] << S5M8767_ENCTRL_SHIFT;
 202
 203	return 0;
 204}
 205
 206static int s5m8767_get_vsel_reg(int reg_id, struct s5m8767_info *s5m8767)
 207{
 208	int reg;
 209
 210	switch (reg_id) {
 211	case S5M8767_LDO1 ... S5M8767_LDO2:
 212		reg = S5M8767_REG_LDO1CTRL + (reg_id - S5M8767_LDO1);
 213		break;
 214	case S5M8767_LDO3 ... S5M8767_LDO28:
 215		reg = S5M8767_REG_LDO3CTRL + (reg_id - S5M8767_LDO3);
 216		break;
 217	case S5M8767_BUCK1:
 218		reg = S5M8767_REG_BUCK1CTRL2;
 219		break;
 220	case S5M8767_BUCK2:
 221		reg = S5M8767_REG_BUCK2DVS1;
 222		if (s5m8767->buck2_gpiodvs)
 223			reg += s5m8767->buck_gpioindex;
 224		break;
 225	case S5M8767_BUCK3:
 226		reg = S5M8767_REG_BUCK3DVS1;
 227		if (s5m8767->buck3_gpiodvs)
 228			reg += s5m8767->buck_gpioindex;
 229		break;
 230	case S5M8767_BUCK4:
 231		reg = S5M8767_REG_BUCK4DVS1;
 232		if (s5m8767->buck4_gpiodvs)
 233			reg += s5m8767->buck_gpioindex;
 234		break;
 235	case S5M8767_BUCK5:
 236		reg = S5M8767_REG_BUCK5CTRL2;
 237		break;
 238	case S5M8767_BUCK6 ... S5M8767_BUCK9:
 239		reg = S5M8767_REG_BUCK6CTRL2 + (reg_id - S5M8767_BUCK6) * 2;
 240		break;
 241	default:
 242		return -EINVAL;
 243	}
 244
 245	return reg;
 246}
 247
 248static int s5m8767_convert_voltage_to_sel(const struct sec_voltage_desc *desc,
 249					  int min_vol)
 250{
 251	int selector = 0;
 252
 253	if (desc == NULL)
 254		return -EINVAL;
 255
 256	if (min_vol > desc->max)
 257		return -EINVAL;
 258
 259	if (min_vol < desc->min)
 260		min_vol = desc->min;
 261
 262	selector = DIV_ROUND_UP(min_vol - desc->min, desc->step);
 263
 264	if (desc->min + desc->step * selector > desc->max)
 265		return -EINVAL;
 266
 267	return selector;
 268}
 269
 270static inline int s5m8767_set_high(struct s5m8767_info *s5m8767)
 271{
 272	int temp_index = s5m8767->buck_gpioindex;
 273
 274	gpio_set_value(s5m8767->buck_gpios[0], (temp_index >> 2) & 0x1);
 275	gpio_set_value(s5m8767->buck_gpios[1], (temp_index >> 1) & 0x1);
 276	gpio_set_value(s5m8767->buck_gpios[2], temp_index & 0x1);
 277
 278	return 0;
 279}
 280
 281static inline int s5m8767_set_low(struct s5m8767_info *s5m8767)
 282{
 283	int temp_index = s5m8767->buck_gpioindex;
 284
 285	gpio_set_value(s5m8767->buck_gpios[2], temp_index & 0x1);
 286	gpio_set_value(s5m8767->buck_gpios[1], (temp_index >> 1) & 0x1);
 287	gpio_set_value(s5m8767->buck_gpios[0], (temp_index >> 2) & 0x1);
 288
 289	return 0;
 290}
 291
 292static int s5m8767_set_voltage_sel(struct regulator_dev *rdev,
 293				   unsigned selector)
 294{
 295	struct s5m8767_info *s5m8767 = rdev_get_drvdata(rdev);
 296	int reg_id = rdev_get_id(rdev);
 297	int old_index, index = 0;
 298	u8 *buck234_vol = NULL;
 299
 300	switch (reg_id) {
 301	case S5M8767_LDO1 ... S5M8767_LDO28:
 302		break;
 303	case S5M8767_BUCK1 ... S5M8767_BUCK6:
 304		if (reg_id == S5M8767_BUCK2 && s5m8767->buck2_gpiodvs)
 305			buck234_vol = &s5m8767->buck2_vol[0];
 306		else if (reg_id == S5M8767_BUCK3 && s5m8767->buck3_gpiodvs)
 307			buck234_vol = &s5m8767->buck3_vol[0];
 308		else if (reg_id == S5M8767_BUCK4 && s5m8767->buck4_gpiodvs)
 309			buck234_vol = &s5m8767->buck4_vol[0];
 310		break;
 311	case S5M8767_BUCK7 ... S5M8767_BUCK8:
 312		return -EINVAL;
 313	case S5M8767_BUCK9:
 314		break;
 315	default:
 316		return -EINVAL;
 317	}
 318
 319	/* buck234_vol != NULL means to control buck234 voltage via DVS GPIO */
 320	if (buck234_vol) {
 321		while (*buck234_vol != selector) {
 322			buck234_vol++;
 323			index++;
 324		}
 325		old_index = s5m8767->buck_gpioindex;
 326		s5m8767->buck_gpioindex = index;
 327
 328		if (index > old_index)
 329			return s5m8767_set_high(s5m8767);
 330		else
 331			return s5m8767_set_low(s5m8767);
 332	} else {
 333		return regulator_set_voltage_sel_regmap(rdev, selector);
 334	}
 335}
 336
 337static int s5m8767_set_voltage_time_sel(struct regulator_dev *rdev,
 338					     unsigned int old_sel,
 339					     unsigned int new_sel)
 340{
 341	struct s5m8767_info *s5m8767 = rdev_get_drvdata(rdev);
 342
 343	if ((old_sel < new_sel) && s5m8767->ramp_delay)
 344		return DIV_ROUND_UP(rdev->desc->uV_step * (new_sel - old_sel),
 345					s5m8767->ramp_delay * 1000);
 346	return 0;
 347}
 348
 349static const struct regulator_ops s5m8767_ops = {
 350	.list_voltage		= regulator_list_voltage_linear,
 351	.is_enabled		= regulator_is_enabled_regmap,
 352	.enable			= regulator_enable_regmap,
 353	.disable		= regulator_disable_regmap,
 354	.get_voltage_sel	= regulator_get_voltage_sel_regmap,
 355	.set_voltage_sel	= s5m8767_set_voltage_sel,
 356	.set_voltage_time_sel	= s5m8767_set_voltage_time_sel,
 357};
 358
 359static const struct regulator_ops s5m8767_buck78_ops = {
 360	.list_voltage		= regulator_list_voltage_linear,
 361	.is_enabled		= regulator_is_enabled_regmap,
 362	.enable			= regulator_enable_regmap,
 363	.disable		= regulator_disable_regmap,
 364	.get_voltage_sel	= regulator_get_voltage_sel_regmap,
 365	.set_voltage_sel	= regulator_set_voltage_sel_regmap,
 366};
 367
 368#define s5m8767_regulator_desc(_name) {		\
 369	.name		= #_name,		\
 370	.id		= S5M8767_##_name,	\
 371	.ops		= &s5m8767_ops,		\
 372	.type		= REGULATOR_VOLTAGE,	\
 373	.owner		= THIS_MODULE,		\
 374}
 375
 376#define s5m8767_regulator_buck78_desc(_name) {	\
 377	.name		= #_name,		\
 378	.id		= S5M8767_##_name,	\
 379	.ops		= &s5m8767_buck78_ops,	\
 380	.type		= REGULATOR_VOLTAGE,	\
 381	.owner		= THIS_MODULE,		\
 382}
 383
 384static struct regulator_desc regulators[] = {
 385	s5m8767_regulator_desc(LDO1),
 386	s5m8767_regulator_desc(LDO2),
 387	s5m8767_regulator_desc(LDO3),
 388	s5m8767_regulator_desc(LDO4),
 389	s5m8767_regulator_desc(LDO5),
 390	s5m8767_regulator_desc(LDO6),
 391	s5m8767_regulator_desc(LDO7),
 392	s5m8767_regulator_desc(LDO8),
 393	s5m8767_regulator_desc(LDO9),
 394	s5m8767_regulator_desc(LDO10),
 395	s5m8767_regulator_desc(LDO11),
 396	s5m8767_regulator_desc(LDO12),
 397	s5m8767_regulator_desc(LDO13),
 398	s5m8767_regulator_desc(LDO14),
 399	s5m8767_regulator_desc(LDO15),
 400	s5m8767_regulator_desc(LDO16),
 401	s5m8767_regulator_desc(LDO17),
 402	s5m8767_regulator_desc(LDO18),
 403	s5m8767_regulator_desc(LDO19),
 404	s5m8767_regulator_desc(LDO20),
 405	s5m8767_regulator_desc(LDO21),
 406	s5m8767_regulator_desc(LDO22),
 407	s5m8767_regulator_desc(LDO23),
 408	s5m8767_regulator_desc(LDO24),
 409	s5m8767_regulator_desc(LDO25),
 410	s5m8767_regulator_desc(LDO26),
 411	s5m8767_regulator_desc(LDO27),
 412	s5m8767_regulator_desc(LDO28),
 413	s5m8767_regulator_desc(BUCK1),
 414	s5m8767_regulator_desc(BUCK2),
 415	s5m8767_regulator_desc(BUCK3),
 416	s5m8767_regulator_desc(BUCK4),
 417	s5m8767_regulator_desc(BUCK5),
 418	s5m8767_regulator_desc(BUCK6),
 419	s5m8767_regulator_buck78_desc(BUCK7),
 420	s5m8767_regulator_buck78_desc(BUCK8),
 421	s5m8767_regulator_desc(BUCK9),
 422};
 423
 424/*
 425 * Enable GPIO control over BUCK9 in regulator_config for that regulator.
 426 */
 427static void s5m8767_regulator_config_ext_control(struct s5m8767_info *s5m8767,
 428		struct sec_regulator_data *rdata,
 429		struct regulator_config *config)
 430{
 431	int i, mode = 0;
 432
 433	if (rdata->id != S5M8767_BUCK9)
 434		return;
 435
 436	/* Check if opmode for regulator matches S5M8767_ENCTRL_USE_GPIO */
 437	for (i = 0; i < s5m8767->num_regulators; i++) {
 438		const struct sec_opmode_data *opmode = &s5m8767->opmode[i];
 439		if (opmode->id == rdata->id) {
 440			mode = s5m8767_opmode_reg[rdata->id][opmode->mode];
 441			break;
 442		}
 443	}
 444	if (mode != S5M8767_ENCTRL_USE_GPIO) {
 445		dev_warn(s5m8767->dev,
 446				"ext-control for %pOFn: mismatched op_mode (%x), ignoring\n",
 447				rdata->reg_node, mode);
 448		return;
 449	}
 450
 451	if (!rdata->ext_control_gpiod) {
 452		dev_warn(s5m8767->dev,
 453				"ext-control for %pOFn: GPIO not valid, ignoring\n",
 454			 rdata->reg_node);
 455		return;
 456	}
 457
 458	config->ena_gpiod = rdata->ext_control_gpiod;
 459}
 460
 461/*
 462 * Turn on GPIO control over BUCK9.
 463 */
 464static int s5m8767_enable_ext_control(struct s5m8767_info *s5m8767,
 465		struct regulator_dev *rdev)
 466{
 467	int id = rdev_get_id(rdev);
 468	int ret, reg, enable_ctrl;
 469
 470	if (id != S5M8767_BUCK9)
 471		return -EINVAL;
 472
 473	ret = s5m8767_get_register(s5m8767, id, &reg, &enable_ctrl);
 474	if (ret)
 475		return ret;
 476
 477	return regmap_update_bits(s5m8767->iodev->regmap_pmic,
 478			reg, S5M8767_ENCTRL_MASK,
 479			S5M8767_ENCTRL_USE_GPIO << S5M8767_ENCTRL_SHIFT);
 480}
 481
 482
 483#ifdef CONFIG_OF
 484static int s5m8767_pmic_dt_parse_dvs_gpio(struct sec_pmic_dev *iodev,
 485			struct sec_platform_data *pdata,
 486			struct device_node *pmic_np)
 487{
 488	int i, gpio;
 489
 490	for (i = 0; i < 3; i++) {
 491		gpio = of_get_named_gpio(pmic_np,
 492					"s5m8767,pmic-buck-dvs-gpios", i);
 493		if (!gpio_is_valid(gpio)) {
 494			dev_err(iodev->dev, "invalid gpio[%d]: %d\n", i, gpio);
 495			return -EINVAL;
 496		}
 497		pdata->buck_gpios[i] = gpio;
 498	}
 499	return 0;
 500}
 501
 502static int s5m8767_pmic_dt_parse_ds_gpio(struct sec_pmic_dev *iodev,
 503			struct sec_platform_data *pdata,
 504			struct device_node *pmic_np)
 505{
 506	int i, gpio;
 507
 508	for (i = 0; i < 3; i++) {
 509		gpio = of_get_named_gpio(pmic_np,
 510					"s5m8767,pmic-buck-ds-gpios", i);
 511		if (!gpio_is_valid(gpio)) {
 512			dev_err(iodev->dev, "invalid gpio[%d]: %d\n", i, gpio);
 513			return -EINVAL;
 514		}
 515		pdata->buck_ds[i] = gpio;
 516	}
 517	return 0;
 518}
 519
 520static int s5m8767_pmic_dt_parse_pdata(struct platform_device *pdev,
 521					struct sec_platform_data *pdata)
 522{
 523	struct sec_pmic_dev *iodev = dev_get_drvdata(pdev->dev.parent);
 524	struct device_node *pmic_np, *regulators_np, *reg_np;
 525	struct sec_regulator_data *rdata;
 526	struct sec_opmode_data *rmode;
 527	unsigned int i, dvs_voltage_nr = 8, ret;
 528
 529	pmic_np = iodev->dev->of_node;
 530	if (!pmic_np) {
 531		dev_err(iodev->dev, "could not find pmic sub-node\n");
 532		return -ENODEV;
 533	}
 534
 535	regulators_np = of_get_child_by_name(pmic_np, "regulators");
 536	if (!regulators_np) {
 537		dev_err(iodev->dev, "could not find regulators sub-node\n");
 538		return -EINVAL;
 539	}
 540
 541	/* count the number of regulators to be supported in pmic */
 542	pdata->num_regulators = of_get_child_count(regulators_np);
 543
 544	rdata = devm_kcalloc(&pdev->dev,
 545			     pdata->num_regulators, sizeof(*rdata),
 546			     GFP_KERNEL);
 547	if (!rdata) {
 548		of_node_put(regulators_np);
 549		return -ENOMEM;
 550	}
 551
 552	rmode = devm_kcalloc(&pdev->dev,
 553			     pdata->num_regulators, sizeof(*rmode),
 554			     GFP_KERNEL);
 555	if (!rmode) {
 556		of_node_put(regulators_np);
 557		return -ENOMEM;
 558	}
 559
 560	pdata->regulators = rdata;
 561	pdata->opmode = rmode;
 562	for_each_child_of_node(regulators_np, reg_np) {
 563		for (i = 0; i < ARRAY_SIZE(regulators); i++)
 564			if (of_node_name_eq(reg_np, regulators[i].name))
 565				break;
 566
 567		if (i == ARRAY_SIZE(regulators)) {
 568			dev_warn(iodev->dev,
 569			"don't know how to configure regulator %pOFn\n",
 570			reg_np);
 571			continue;
 572		}
 573
 574		rdata->ext_control_gpiod = devm_fwnode_gpiod_get(
 575			&pdev->dev,
 576			of_fwnode_handle(reg_np),
 577			"s5m8767,pmic-ext-control",
 578			GPIOD_OUT_HIGH | GPIOD_FLAGS_BIT_NONEXCLUSIVE,
 579			"s5m8767");
 580		if (PTR_ERR(rdata->ext_control_gpiod) == -ENOENT) {
 581			rdata->ext_control_gpiod = NULL;
 582		} else if (IS_ERR(rdata->ext_control_gpiod)) {
 583			of_node_put(reg_np);
 584			of_node_put(regulators_np);
 585			return PTR_ERR(rdata->ext_control_gpiod);
 586		}
 587
 588		rdata->id = i;
 589		rdata->initdata = of_get_regulator_init_data(
 590						&pdev->dev, reg_np,
 591						&regulators[i]);
 592		rdata->reg_node = reg_np;
 593		rdata++;
 594		rmode->id = i;
 595		if (of_property_read_u32(reg_np, "op_mode",
 596				&rmode->mode)) {
 597			dev_warn(iodev->dev,
 598				"no op_mode property at %pOF\n",
 599				reg_np);
 600
 601			rmode->mode = S5M8767_OPMODE_NORMAL_MODE;
 602		}
 603		rmode++;
 604	}
 605
 606	of_node_put(regulators_np);
 607
 608	if (of_property_read_bool(pmic_np, "s5m8767,pmic-buck2-uses-gpio-dvs")) {
 609		pdata->buck2_gpiodvs = true;
 610
 611		if (of_property_read_u32_array(pmic_np,
 612				"s5m8767,pmic-buck2-dvs-voltage",
 613				pdata->buck2_voltage, dvs_voltage_nr)) {
 614			dev_err(iodev->dev, "buck2 voltages not specified\n");
 615			return -EINVAL;
 616		}
 617	}
 618
 619	if (of_property_read_bool(pmic_np, "s5m8767,pmic-buck3-uses-gpio-dvs")) {
 620		pdata->buck3_gpiodvs = true;
 621
 622		if (of_property_read_u32_array(pmic_np,
 623				"s5m8767,pmic-buck3-dvs-voltage",
 624				pdata->buck3_voltage, dvs_voltage_nr)) {
 625			dev_err(iodev->dev, "buck3 voltages not specified\n");
 626			return -EINVAL;
 627		}
 628	}
 629
 630	if (of_property_read_bool(pmic_np, "s5m8767,pmic-buck4-uses-gpio-dvs")) {
 631		pdata->buck4_gpiodvs = true;
 632
 633		if (of_property_read_u32_array(pmic_np,
 634				"s5m8767,pmic-buck4-dvs-voltage",
 635				pdata->buck4_voltage, dvs_voltage_nr)) {
 636			dev_err(iodev->dev, "buck4 voltages not specified\n");
 637			return -EINVAL;
 638		}
 639	}
 640
 641	if (pdata->buck2_gpiodvs || pdata->buck3_gpiodvs ||
 642						pdata->buck4_gpiodvs) {
 643		ret = s5m8767_pmic_dt_parse_dvs_gpio(iodev, pdata, pmic_np);
 644		if (ret)
 645			return -EINVAL;
 646
 647		if (of_property_read_u32(pmic_np,
 648				"s5m8767,pmic-buck-default-dvs-idx",
 649				&pdata->buck_default_idx)) {
 650			pdata->buck_default_idx = 0;
 651		} else {
 652			if (pdata->buck_default_idx >= 8) {
 653				pdata->buck_default_idx = 0;
 654				dev_info(iodev->dev,
 655				"invalid value for default dvs index, use 0\n");
 656			}
 657		}
 658	}
 659
 660	ret = s5m8767_pmic_dt_parse_ds_gpio(iodev, pdata, pmic_np);
 661	if (ret)
 662		return -EINVAL;
 663
 664	pdata->buck2_ramp_enable = of_property_read_bool(pmic_np, "s5m8767,pmic-buck2-ramp-enable");
 665	pdata->buck3_ramp_enable = of_property_read_bool(pmic_np, "s5m8767,pmic-buck3-ramp-enable");
 666	pdata->buck4_ramp_enable = of_property_read_bool(pmic_np, "s5m8767,pmic-buck4-ramp-enable");
 667
 668	if (pdata->buck2_ramp_enable || pdata->buck3_ramp_enable
 669			|| pdata->buck4_ramp_enable) {
 670		if (of_property_read_u32(pmic_np, "s5m8767,pmic-buck-ramp-delay",
 671				&pdata->buck_ramp_delay))
 672			pdata->buck_ramp_delay = 0;
 673	}
 674
 675	return 0;
 676}
 677#else
 678static int s5m8767_pmic_dt_parse_pdata(struct platform_device *pdev,
 679					struct sec_platform_data *pdata)
 680{
 681	return 0;
 682}
 683#endif /* CONFIG_OF */
 684
 685static int s5m8767_pmic_probe(struct platform_device *pdev)
 686{
 687	struct sec_pmic_dev *iodev = dev_get_drvdata(pdev->dev.parent);
 688	struct sec_platform_data *pdata = iodev->pdata;
 689	struct regulator_config config = { };
 690	struct s5m8767_info *s5m8767;
 691	int i, ret, buck_init;
 692
 693	if (!pdata) {
 694		dev_err(pdev->dev.parent, "Platform data not supplied\n");
 695		return -ENODEV;
 696	}
 697
 698	if (iodev->dev->of_node) {
 699		ret = s5m8767_pmic_dt_parse_pdata(pdev, pdata);
 700		if (ret)
 701			return ret;
 702	}
 703
 704	if (pdata->buck2_gpiodvs) {
 705		if (pdata->buck3_gpiodvs || pdata->buck4_gpiodvs) {
 706			dev_err(&pdev->dev, "S5M8767 GPIO DVS NOT VALID\n");
 707			return -EINVAL;
 708		}
 709	}
 710
 711	if (pdata->buck3_gpiodvs) {
 712		if (pdata->buck2_gpiodvs || pdata->buck4_gpiodvs) {
 713			dev_err(&pdev->dev, "S5M8767 GPIO DVS NOT VALID\n");
 714			return -EINVAL;
 715		}
 716	}
 717
 718	if (pdata->buck4_gpiodvs) {
 719		if (pdata->buck2_gpiodvs || pdata->buck3_gpiodvs) {
 720			dev_err(&pdev->dev, "S5M8767 GPIO DVS NOT VALID\n");
 721			return -EINVAL;
 722		}
 723	}
 724
 725	s5m8767 = devm_kzalloc(&pdev->dev, sizeof(struct s5m8767_info),
 726				GFP_KERNEL);
 727	if (!s5m8767)
 728		return -ENOMEM;
 729
 730	s5m8767->dev = &pdev->dev;
 731	s5m8767->iodev = iodev;
 732	s5m8767->num_regulators = pdata->num_regulators;
 733	platform_set_drvdata(pdev, s5m8767);
 734
 735	s5m8767->buck_gpioindex = pdata->buck_default_idx;
 736	s5m8767->buck2_gpiodvs = pdata->buck2_gpiodvs;
 737	s5m8767->buck3_gpiodvs = pdata->buck3_gpiodvs;
 738	s5m8767->buck4_gpiodvs = pdata->buck4_gpiodvs;
 739	s5m8767->buck_gpios[0] = pdata->buck_gpios[0];
 740	s5m8767->buck_gpios[1] = pdata->buck_gpios[1];
 741	s5m8767->buck_gpios[2] = pdata->buck_gpios[2];
 742	s5m8767->buck_ds[0] = pdata->buck_ds[0];
 743	s5m8767->buck_ds[1] = pdata->buck_ds[1];
 744	s5m8767->buck_ds[2] = pdata->buck_ds[2];
 745
 746	s5m8767->ramp_delay = pdata->buck_ramp_delay;
 747	s5m8767->buck2_ramp = pdata->buck2_ramp_enable;
 748	s5m8767->buck3_ramp = pdata->buck3_ramp_enable;
 749	s5m8767->buck4_ramp = pdata->buck4_ramp_enable;
 750	s5m8767->opmode = pdata->opmode;
 751
 752	buck_init = s5m8767_convert_voltage_to_sel(&buck_voltage_val2,
 753						   pdata->buck2_init);
 754
 755	regmap_write(s5m8767->iodev->regmap_pmic, S5M8767_REG_BUCK2DVS2,
 756			buck_init);
 757
 758	buck_init = s5m8767_convert_voltage_to_sel(&buck_voltage_val2,
 759						   pdata->buck3_init);
 760
 761	regmap_write(s5m8767->iodev->regmap_pmic, S5M8767_REG_BUCK3DVS2,
 762			buck_init);
 763
 764	buck_init = s5m8767_convert_voltage_to_sel(&buck_voltage_val2,
 765						   pdata->buck4_init);
 766
 767	regmap_write(s5m8767->iodev->regmap_pmic, S5M8767_REG_BUCK4DVS2,
 768			buck_init);
 769
 770	for (i = 0; i < 8; i++) {
 771		if (s5m8767->buck2_gpiodvs) {
 772			s5m8767->buck2_vol[i] =
 773				s5m8767_convert_voltage_to_sel(
 774						&buck_voltage_val2,
 775						pdata->buck2_voltage[i]);
 776		}
 777
 778		if (s5m8767->buck3_gpiodvs) {
 779			s5m8767->buck3_vol[i] =
 780				s5m8767_convert_voltage_to_sel(
 781						&buck_voltage_val2,
 782						pdata->buck3_voltage[i]);
 783		}
 784
 785		if (s5m8767->buck4_gpiodvs) {
 786			s5m8767->buck4_vol[i] =
 787				s5m8767_convert_voltage_to_sel(
 788						&buck_voltage_val2,
 789						pdata->buck4_voltage[i]);
 790		}
 791	}
 792
 793	if (pdata->buck2_gpiodvs || pdata->buck3_gpiodvs ||
 794						pdata->buck4_gpiodvs) {
 795
 796		if (!gpio_is_valid(pdata->buck_gpios[0]) ||
 797			!gpio_is_valid(pdata->buck_gpios[1]) ||
 798			!gpio_is_valid(pdata->buck_gpios[2])) {
 799			dev_err(&pdev->dev, "GPIO NOT VALID\n");
 800			return -EINVAL;
 801		}
 802
 803		ret = devm_gpio_request(&pdev->dev, pdata->buck_gpios[0],
 804					"S5M8767 SET1");
 805		if (ret)
 806			return ret;
 807
 808		ret = devm_gpio_request(&pdev->dev, pdata->buck_gpios[1],
 809					"S5M8767 SET2");
 810		if (ret)
 811			return ret;
 812
 813		ret = devm_gpio_request(&pdev->dev, pdata->buck_gpios[2],
 814					"S5M8767 SET3");
 815		if (ret)
 816			return ret;
 817
 818		/* SET1 GPIO */
 819		gpio_direction_output(pdata->buck_gpios[0],
 820				(s5m8767->buck_gpioindex >> 2) & 0x1);
 821		/* SET2 GPIO */
 822		gpio_direction_output(pdata->buck_gpios[1],
 823				(s5m8767->buck_gpioindex >> 1) & 0x1);
 824		/* SET3 GPIO */
 825		gpio_direction_output(pdata->buck_gpios[2],
 826				(s5m8767->buck_gpioindex >> 0) & 0x1);
 827	}
 828
 829	ret = devm_gpio_request(&pdev->dev, pdata->buck_ds[0], "S5M8767 DS2");
 830	if (ret)
 831		return ret;
 832
 833	ret = devm_gpio_request(&pdev->dev, pdata->buck_ds[1], "S5M8767 DS3");
 834	if (ret)
 835		return ret;
 836
 837	ret = devm_gpio_request(&pdev->dev, pdata->buck_ds[2], "S5M8767 DS4");
 838	if (ret)
 839		return ret;
 840
 841	/* DS2 GPIO */
 842	gpio_direction_output(pdata->buck_ds[0], 0x0);
 843	/* DS3 GPIO */
 844	gpio_direction_output(pdata->buck_ds[1], 0x0);
 845	/* DS4 GPIO */
 846	gpio_direction_output(pdata->buck_ds[2], 0x0);
 847
 848	regmap_update_bits(s5m8767->iodev->regmap_pmic,
 849			   S5M8767_REG_BUCK2CTRL, 1 << 1,
 850			   (pdata->buck2_gpiodvs) ? (1 << 1) : (0 << 1));
 851	regmap_update_bits(s5m8767->iodev->regmap_pmic,
 852			   S5M8767_REG_BUCK3CTRL, 1 << 1,
 853			   (pdata->buck3_gpiodvs) ? (1 << 1) : (0 << 1));
 854	regmap_update_bits(s5m8767->iodev->regmap_pmic,
 855			   S5M8767_REG_BUCK4CTRL, 1 << 1,
 856			   (pdata->buck4_gpiodvs) ? (1 << 1) : (0 << 1));
 857
 858	/* Initialize GPIO DVS registers */
 859	for (i = 0; i < 8; i++) {
 860		if (s5m8767->buck2_gpiodvs) {
 861			regmap_write(s5m8767->iodev->regmap_pmic,
 862					S5M8767_REG_BUCK2DVS1 + i,
 863					s5m8767->buck2_vol[i]);
 864		}
 865
 866		if (s5m8767->buck3_gpiodvs) {
 867			regmap_write(s5m8767->iodev->regmap_pmic,
 868					S5M8767_REG_BUCK3DVS1 + i,
 869					s5m8767->buck3_vol[i]);
 870		}
 871
 872		if (s5m8767->buck4_gpiodvs) {
 873			regmap_write(s5m8767->iodev->regmap_pmic,
 874					S5M8767_REG_BUCK4DVS1 + i,
 875					s5m8767->buck4_vol[i]);
 876		}
 877	}
 878
 879	if (s5m8767->buck2_ramp)
 880		regmap_update_bits(s5m8767->iodev->regmap_pmic,
 881				S5M8767_REG_DVSRAMP, 0x08, 0x08);
 882
 883	if (s5m8767->buck3_ramp)
 884		regmap_update_bits(s5m8767->iodev->regmap_pmic,
 885				S5M8767_REG_DVSRAMP, 0x04, 0x04);
 886
 887	if (s5m8767->buck4_ramp)
 888		regmap_update_bits(s5m8767->iodev->regmap_pmic,
 889				S5M8767_REG_DVSRAMP, 0x02, 0x02);
 890
 891	if (s5m8767->buck2_ramp || s5m8767->buck3_ramp
 892		|| s5m8767->buck4_ramp) {
 893		unsigned int val;
 894		switch (s5m8767->ramp_delay) {
 895		case 5:
 896			val = S5M8767_DVS_BUCK_RAMP_5;
 897			break;
 898		case 10:
 899			val = S5M8767_DVS_BUCK_RAMP_10;
 900			break;
 901		case 25:
 902			val = S5M8767_DVS_BUCK_RAMP_25;
 903			break;
 904		case 50:
 905			val = S5M8767_DVS_BUCK_RAMP_50;
 906			break;
 907		case 100:
 908			val = S5M8767_DVS_BUCK_RAMP_100;
 909			break;
 910		default:
 911			val = S5M8767_DVS_BUCK_RAMP_10;
 912		}
 913		regmap_update_bits(s5m8767->iodev->regmap_pmic,
 914					S5M8767_REG_DVSRAMP,
 915					S5M8767_DVS_BUCK_RAMP_MASK,
 916					val << S5M8767_DVS_BUCK_RAMP_SHIFT);
 917	}
 918
 919	for (i = 0; i < pdata->num_regulators; i++) {
 920		const struct sec_voltage_desc *desc;
 921		unsigned int id = pdata->regulators[i].id;
 922		int enable_reg, enable_val;
 923		struct regulator_dev *rdev;
 924
 925		BUILD_BUG_ON(ARRAY_SIZE(regulators) != ARRAY_SIZE(reg_voltage_map));
 926		if (WARN_ON_ONCE(id >= ARRAY_SIZE(regulators)))
 927			continue;
 928
 929		desc = reg_voltage_map[id];
 930		if (desc) {
 931			regulators[id].n_voltages =
 932				(desc->max - desc->min) / desc->step + 1;
 933			regulators[id].min_uV = desc->min;
 934			regulators[id].uV_step = desc->step;
 935			regulators[id].vsel_reg =
 936				s5m8767_get_vsel_reg(id, s5m8767);
 937			if (id < S5M8767_BUCK1)
 938				regulators[id].vsel_mask = 0x3f;
 939			else
 940				regulators[id].vsel_mask = 0xff;
 941
 942			ret = s5m8767_get_register(s5m8767, id, &enable_reg,
 943					     &enable_val);
 944			if (ret) {
 945				dev_err(s5m8767->dev, "error reading registers\n");
 946				return ret;
 947			}
 948			regulators[id].enable_reg = enable_reg;
 949			regulators[id].enable_mask = S5M8767_ENCTRL_MASK;
 950			regulators[id].enable_val = enable_val;
 951		}
 952
 953		config.dev = s5m8767->dev;
 954		config.init_data = pdata->regulators[i].initdata;
 955		config.driver_data = s5m8767;
 956		config.regmap = iodev->regmap_pmic;
 957		config.of_node = pdata->regulators[i].reg_node;
 958		config.ena_gpiod = NULL;
 959		if (pdata->regulators[i].ext_control_gpiod) {
 960			/* Assigns config.ena_gpiod */
 961			s5m8767_regulator_config_ext_control(s5m8767,
 962					&pdata->regulators[i], &config);
 963
 964			/*
 965			 * Hand the GPIO descriptor management over to the
 966			 * regulator core, remove it from devres management.
 967			 */
 968			devm_gpiod_unhinge(s5m8767->dev, config.ena_gpiod);
 969		}
 970		rdev = devm_regulator_register(&pdev->dev, &regulators[id],
 971						  &config);
 972		if (IS_ERR(rdev)) {
 973			ret = PTR_ERR(rdev);
 974			dev_err(s5m8767->dev, "regulator init failed for %d\n",
 975					id);
 976			return ret;
 977		}
 978
 979		if (pdata->regulators[i].ext_control_gpiod) {
 980			ret = s5m8767_enable_ext_control(s5m8767, rdev);
 981			if (ret < 0) {
 982				dev_err(s5m8767->dev,
 983						"failed to enable gpio control over %s: %d\n",
 984						rdev->desc->name, ret);
 985				return ret;
 986			}
 987		}
 988	}
 989
 990	return 0;
 991}
 992
 993static const struct platform_device_id s5m8767_pmic_id[] = {
 994	{ "s5m8767-pmic", 0},
 995	{ },
 996};
 997MODULE_DEVICE_TABLE(platform, s5m8767_pmic_id);
 998
 999static struct platform_driver s5m8767_pmic_driver = {
1000	.driver = {
1001		.name = "s5m8767-pmic",
1002		.probe_type = PROBE_PREFER_ASYNCHRONOUS,
1003	},
1004	.probe = s5m8767_pmic_probe,
1005	.id_table = s5m8767_pmic_id,
1006};
1007module_platform_driver(s5m8767_pmic_driver);
1008
1009/* Module information */
1010MODULE_AUTHOR("Sangbeom Kim <sbkim73@samsung.com>");
1011MODULE_DESCRIPTION("Samsung S5M8767 Regulator Driver");
1012MODULE_LICENSE("GPL");