[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / regulator / tps6586x-regulator.c

/*
 * Regulator driver for TI TPS6586x
 *
 * Copyright (C) 2010 Compulab Ltd.
 * Author: Mike Rapoport <mike@compulab.co.il>
 *
 * Based on da903x
 * Copyright (C) 2006-2008 Marvell International Ltd.
 * Copyright (C) 2008 Compulab Ltd.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/err.h>
#include <linux/of.h>
#include <linux/slab.h>
#include <linux/platform_device.h>
#include <linux/regulator/driver.h>
#include <linux/regulator/machine.h>
#include <linux/regulator/of_regulator.h>
#include <linux/mfd/tps6586x.h>

/* supply control and voltage setting  */
#define TPS6586X_SUPPLYENA	0x10
#define TPS6586X_SUPPLYENB	0x11
#define TPS6586X_SUPPLYENC	0x12
#define TPS6586X_SUPPLYEND	0x13
#define TPS6586X_SUPPLYENE	0x14
#define TPS6586X_VCC1		0x20
#define TPS6586X_VCC2		0x21
#define TPS6586X_SM1V1		0x23
#define TPS6586X_SM1V2		0x24
#define TPS6586X_SM1SL		0x25
#define TPS6586X_SM0V1		0x26
#define TPS6586X_SM0V2		0x27
#define TPS6586X_SM0SL		0x28
#define TPS6586X_LDO2AV1	0x29
#define TPS6586X_LDO2AV2	0x2A
#define TPS6586X_LDO2BV1	0x2F
#define TPS6586X_LDO2BV2	0x30
#define TPS6586X_LDO4V1		0x32
#define TPS6586X_LDO4V2		0x33

/* converter settings  */
#define TPS6586X_SUPPLYV1	0x41
#define TPS6586X_SUPPLYV2	0x42
#define TPS6586X_SUPPLYV3	0x43
#define TPS6586X_SUPPLYV4	0x44
#define TPS6586X_SUPPLYV5	0x45
#define TPS6586X_SUPPLYV6	0x46
#define TPS6586X_SMODE1		0x47
#define TPS6586X_SMODE2		0x48

struct tps6586x_regulator {
	struct regulator_desc desc;

	int enable_bit[2];
	int enable_reg[2];

	/* for DVM regulators */
	int go_reg;
	int go_bit;
};

static inline struct device *to_tps6586x_dev(struct regulator_dev *rdev)
{
	return rdev_get_dev(rdev)->parent;
}

static int tps6586x_set_voltage_sel(struct regulator_dev *rdev,
				    unsigned selector)
{
	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	struct device *parent = to_tps6586x_dev(rdev);
	int ret, val, rid = rdev_get_id(rdev);
	uint8_t mask;

	val = selector << (ffs(rdev->desc->vsel_mask) - 1);
	mask = rdev->desc->vsel_mask;

	ret = tps6586x_update(parent, rdev->desc->vsel_reg, val, mask);
	if (ret)
		return ret;

	/* Update go bit for DVM regulators */
	switch (rid) {
	case TPS6586X_ID_LDO_2:
	case TPS6586X_ID_LDO_4:
	case TPS6586X_ID_SM_0:
	case TPS6586X_ID_SM_1:
		ret = tps6586x_set_bits(parent, ri->go_reg, 1 << ri->go_bit);
		break;
	}
	return ret;
}

static struct regulator_ops tps6586x_regulator_ops = {
	.list_voltage = regulator_list_voltage_table,
	.get_voltage_sel = regulator_get_voltage_sel_regmap,
	.set_voltage_sel = tps6586x_set_voltage_sel,

	.is_enabled = regulator_is_enabled_regmap,
	.enable = regulator_enable_regmap,
	.disable = regulator_disable_regmap,
};

static struct regulator_ops tps6586x_sys_regulator_ops = {
};

static const unsigned int tps6586x_ldo0_voltages[] = {
	1200000, 1500000, 1800000, 2500000, 2700000, 2850000, 3100000, 3300000,
};

static const unsigned int tps6586x_ldo4_voltages[] = {
	1700000, 1725000, 1750000, 1775000, 1800000, 1825000, 1850000, 1875000,
	1900000, 1925000, 1950000, 1975000, 2000000, 2025000, 2050000, 2075000,
	2100000, 2125000, 2150000, 2175000, 2200000, 2225000, 2250000, 2275000,
	2300000, 2325000, 2350000, 2375000, 2400000, 2425000, 2450000, 2475000,
};

static const unsigned int tps6586x_ldo_voltages[] = {
	1250000, 1500000, 1800000, 2500000, 2700000, 2850000, 3100000, 3300000,
};

static const unsigned int tps6586x_sm2_voltages[] = {
	3000000, 3050000, 3100000, 3150000, 3200000, 3250000, 3300000, 3350000,
	3400000, 3450000, 3500000, 3550000, 3600000, 3650000, 3700000, 3750000,
	3800000, 3850000, 3900000, 3950000, 4000000, 4050000, 4100000, 4150000,
	4200000, 4250000, 4300000, 4350000, 4400000, 4450000, 4500000, 4550000,
};

static const unsigned int tps6586x_dvm_voltages[] = {
	 725000,  750000,  775000,  800000,  825000,  850000,  875000,  900000,
	 925000,  950000,  975000, 1000000, 1025000, 1050000, 1075000, 1100000,
	1125000, 1150000, 1175000, 1200000, 1225000, 1250000, 1275000, 1300000,
	1325000, 1350000, 1375000, 1400000, 1425000, 1450000, 1475000, 1500000,
};

#define TPS6586X_REGULATOR(_id, _pin_name, vdata, vreg, shift, nbits,	\
			   ereg0, ebit0, ereg1, ebit1)			\
	.desc	= {							\
		.supply_name = _pin_name,				\
		.name	= "REG-" #_id,					\
		.ops	= &tps6586x_regulator_ops,			\
		.type	= REGULATOR_VOLTAGE,				\
		.id	= TPS6586X_ID_##_id,				\
		.n_voltages = ARRAY_SIZE(tps6586x_##vdata##_voltages),	\
		.volt_table = tps6586x_##vdata##_voltages,		\
		.owner	= THIS_MODULE,					\
		.enable_reg = TPS6586X_SUPPLY##ereg0,			\
		.enable_mask = 1 << (ebit0),				\
		.vsel_reg = TPS6586X_##vreg,				\
		.vsel_mask = ((1 << (nbits)) - 1) << (shift),		\
	},								\
	.enable_reg[0]	= TPS6586X_SUPPLY##ereg0,			\
	.enable_bit[0]	= (ebit0),					\
	.enable_reg[1]	= TPS6586X_SUPPLY##ereg1,			\
	.enable_bit[1]	= (ebit1),

#define TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit)			\
	.go_reg = TPS6586X_##goreg,					\
	.go_bit = (gobit),

#define TPS6586X_LDO(_id, _pname, vdata, vreg, shift, nbits,		\
		     ereg0, ebit0, ereg1, ebit1)			\
{									\
	TPS6586X_REGULATOR(_id, _pname, vdata, vreg, shift, nbits,	\
			   ereg0, ebit0, ereg1, ebit1)			\
}

#define TPS6586X_DVM(_id, _pname, vdata, vreg, shift, nbits,		\
		     ereg0, ebit0, ereg1, ebit1, goreg, gobit)		\
{									\
	TPS6586X_REGULATOR(_id, _pname, vdata, vreg, shift, nbits,	\
			   ereg0, ebit0, ereg1, ebit1)			\
	TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit)			\
}

#define TPS6586X_SYS_REGULATOR()					\
{									\
	.desc	= {							\
		.supply_name = "sys",					\
		.name	= "REG-SYS",					\
		.ops	= &tps6586x_sys_regulator_ops,			\
		.type	= REGULATOR_VOLTAGE,				\
		.id	= TPS6586X_ID_SYS,				\
		.owner	= THIS_MODULE,					\
	},								\
}

static struct tps6586x_regulator tps6586x_regulator[] = {
	TPS6586X_SYS_REGULATOR(),
	TPS6586X_LDO(LDO_0, "vinldo01", ldo0, SUPPLYV1, 5, 3, ENC, 0, END, 0),
	TPS6586X_LDO(LDO_3, "vinldo23", ldo, SUPPLYV4, 0, 3, ENC, 2, END, 2),
	TPS6586X_LDO(LDO_5, "REG-SYS", ldo, SUPPLYV6, 0, 3, ENE, 6, ENE, 6),
	TPS6586X_LDO(LDO_6, "vinldo678", ldo, SUPPLYV3, 0, 3, ENC, 4, END, 4),
	TPS6586X_LDO(LDO_7, "vinldo678", ldo, SUPPLYV3, 3, 3, ENC, 5, END, 5),
	TPS6586X_LDO(LDO_8, "vinldo678", ldo, SUPPLYV2, 5, 3, ENC, 6, END, 6),
	TPS6586X_LDO(LDO_9, "vinldo9", ldo, SUPPLYV6, 3, 3, ENE, 7, ENE, 7),
	TPS6586X_LDO(LDO_RTC, "REG-SYS", ldo, SUPPLYV4, 3, 3, V4, 7, V4, 7),
	TPS6586X_LDO(LDO_1, "vinldo01", dvm, SUPPLYV1, 0, 5, ENC, 1, END, 1),
	TPS6586X_LDO(SM_2, "vin-sm2", sm2, SUPPLYV2, 0, 5, ENC, 7, END, 7),

	TPS6586X_DVM(LDO_2, "vinldo23", dvm, LDO2BV1, 0, 5, ENA, 3,
					ENB, 3, VCC2, 6),
	TPS6586X_DVM(LDO_4, "vinldo4", ldo4, LDO4V1, 0, 5, ENC, 3,
					END, 3, VCC1, 6),
	TPS6586X_DVM(SM_0, "vin-sm0", dvm, SM0V1, 0, 5, ENA, 1,
					ENB, 1, VCC1, 2),
	TPS6586X_DVM(SM_1, "vin-sm1", dvm, SM1V1, 0, 5, ENA, 0,
					ENB, 0, VCC1, 0),
};

/*
 * TPS6586X has 2 enable bits that are OR'ed to determine the actual
 * regulator state. Clearing one of this bits allows switching
 * regulator on and of with single register write.
 */
static inline int tps6586x_regulator_preinit(struct device *parent,
					     struct tps6586x_regulator *ri)
{
	uint8_t val1, val2;
	int ret;

	if (ri->enable_reg[0] == ri->enable_reg[1] &&
	    ri->enable_bit[0] == ri->enable_bit[1])
			return 0;

	ret = tps6586x_read(parent, ri->enable_reg[0], &val1);
	if (ret)
		return ret;

	ret = tps6586x_read(parent, ri->enable_reg[1], &val2);
	if (ret)
		return ret;

	if (!(val2 & (1 << ri->enable_bit[1])))
		return 0;

	/*
	 * The regulator is on, but it's enabled with the bit we don't
	 * want to use, so we switch the enable bits
	 */
	if (!(val1 & (1 << ri->enable_bit[0]))) {
		ret = tps6586x_set_bits(parent, ri->enable_reg[0],
					1 << ri->enable_bit[0]);
		if (ret)
			return ret;
	}

	return tps6586x_clr_bits(parent, ri->enable_reg[1],
				 1 << ri->enable_bit[1]);
}

static int tps6586x_regulator_set_slew_rate(struct platform_device *pdev,
			int id, struct regulator_init_data *p)
{
	struct device *parent = pdev->dev.parent;
	struct tps6586x_settings *setting = p->driver_data;
	uint8_t reg;

	if (setting == NULL)
		return 0;

	if (!(setting->slew_rate & TPS6586X_SLEW_RATE_SET))
		return 0;

	/* only SM0 and SM1 can have the slew rate settings */
	switch (id) {
	case TPS6586X_ID_SM_0:
		reg = TPS6586X_SM0SL;
		break;
	case TPS6586X_ID_SM_1:
		reg = TPS6586X_SM1SL;
		break;
	default:
		dev_warn(&pdev->dev, "Only SM0/SM1 can set slew rate\n");
		return -EINVAL;
	}

	return tps6586x_write(parent, reg,
			setting->slew_rate & TPS6586X_SLEW_RATE_MASK);
}

static inline struct tps6586x_regulator *find_regulator_info(int id)
{
	struct tps6586x_regulator *ri;
	int i;

	for (i = 0; i < ARRAY_SIZE(tps6586x_regulator); i++) {
		ri = &tps6586x_regulator[i];
		if (ri->desc.id == id)
			return ri;
	}
	return NULL;
}

#ifdef CONFIG_OF
static struct of_regulator_match tps6586x_matches[] = {
	{ .name = "sys",     .driver_data = (void *)TPS6586X_ID_SYS     },
	{ .name = "sm0",     .driver_data = (void *)TPS6586X_ID_SM_0    },
	{ .name = "sm1",     .driver_data = (void *)TPS6586X_ID_SM_1    },
	{ .name = "sm2",     .driver_data = (void *)TPS6586X_ID_SM_2    },
	{ .name = "ldo0",    .driver_data = (void *)TPS6586X_ID_LDO_0   },
	{ .name = "ldo1",    .driver_data = (void *)TPS6586X_ID_LDO_1   },
	{ .name = "ldo2",    .driver_data = (void *)TPS6586X_ID_LDO_2   },
	{ .name = "ldo3",    .driver_data = (void *)TPS6586X_ID_LDO_3   },
	{ .name = "ldo4",    .driver_data = (void *)TPS6586X_ID_LDO_4   },
	{ .name = "ldo5",    .driver_data = (void *)TPS6586X_ID_LDO_5   },
	{ .name = "ldo6",    .driver_data = (void *)TPS6586X_ID_LDO_6   },
	{ .name = "ldo7",    .driver_data = (void *)TPS6586X_ID_LDO_7   },
	{ .name = "ldo8",    .driver_data = (void *)TPS6586X_ID_LDO_8   },
	{ .name = "ldo9",    .driver_data = (void *)TPS6586X_ID_LDO_9   },
	{ .name = "ldo_rtc", .driver_data = (void *)TPS6586X_ID_LDO_RTC },
};

static struct tps6586x_platform_data *tps6586x_parse_regulator_dt(
		struct platform_device *pdev,
		struct of_regulator_match **tps6586x_reg_matches)
{
	const unsigned int num = ARRAY_SIZE(tps6586x_matches);
	struct device_node *np = pdev->dev.parent->of_node;
	struct device_node *regs;
	const char *sys_rail = NULL;
	unsigned int i;
	struct tps6586x_platform_data *pdata;
	int err;

	regs = of_find_node_by_name(np, "regulators");
	if (!regs) {
		dev_err(&pdev->dev, "regulator node not found\n");
		return NULL;
	}

	err = of_regulator_match(&pdev->dev, regs, tps6586x_matches, num);
	if (err < 0) {
		dev_err(&pdev->dev, "Regulator match failed, e %d\n", err);
		of_node_put(regs);
		return NULL;
	}

	of_node_put(regs);

	pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
	if (!pdata) {
		dev_err(&pdev->dev, "Memory alloction failed\n");
		return NULL;
	}

	for (i = 0; i < num; i++) {
		int id;
		if (!tps6586x_matches[i].init_data)
			continue;

		pdata->reg_init_data[i] = tps6586x_matches[i].init_data;
		id = (int)tps6586x_matches[i].driver_data;
		if (id == TPS6586X_ID_SYS)
			sys_rail = pdata->reg_init_data[i]->constraints.name;

		if ((id == TPS6586X_ID_LDO_5) || (id == TPS6586X_ID_LDO_RTC))
			pdata->reg_init_data[i]->supply_regulator = sys_rail;
	}
	*tps6586x_reg_matches = tps6586x_matches;
	return pdata;
}
#else
static struct tps6586x_platform_data *tps6586x_parse_regulator_dt(
		struct platform_device *pdev,
		struct of_regulator_match **tps6586x_reg_matches)
{
	*tps6586x_reg_matches = NULL;
	return NULL;
}
#endif

static int __devinit tps6586x_regulator_probe(struct platform_device *pdev)
{
	struct tps6586x_regulator *ri = NULL;
	struct regulator_config config = { };
	struct regulator_dev **rdev;
	struct regulator_init_data *reg_data;
	struct tps6586x_platform_data *pdata;
	struct of_regulator_match *tps6586x_reg_matches = NULL;
	int id;
	int err;

	dev_dbg(&pdev->dev, "Probing regulator\n");

	pdata = dev_get_platdata(pdev->dev.parent);
	if ((!pdata) && (pdev->dev.parent->of_node))
		pdata = tps6586x_parse_regulator_dt(pdev,
					&tps6586x_reg_matches);

	if (!pdata) {
		dev_err(&pdev->dev, "Platform data not available, exiting\n");
		return -ENODEV;
	}

	rdev = devm_kzalloc(&pdev->dev, TPS6586X_ID_MAX_REGULATOR *
				sizeof(*rdev), GFP_KERNEL);
	if (!rdev) {
		dev_err(&pdev->dev, "Mmemory alloc failed\n");
		return -ENOMEM;
	}

	for (id = 0; id < TPS6586X_ID_MAX_REGULATOR; ++id) {
		reg_data = pdata->reg_init_data[id];

		ri = find_regulator_info(id);
		if (!ri) {
			dev_err(&pdev->dev, "invalid regulator ID specified\n");
			err = -EINVAL;
			goto fail;
		}

		err = tps6586x_regulator_preinit(pdev->dev.parent, ri);
		if (err) {
			dev_err(&pdev->dev,
				"regulator %d preinit failed, e %d\n", id, err);
			goto fail;
		}

		config.dev = pdev->dev.parent;
		config.init_data = reg_data;
		config.driver_data = ri;

		if (tps6586x_reg_matches)
			config.of_node = tps6586x_reg_matches[id].of_node;

		rdev[id] = regulator_register(&ri->desc, &config);
		if (IS_ERR(rdev[id])) {
			dev_err(&pdev->dev, "failed to register regulator %s\n",
					ri->desc.name);
			err = PTR_ERR(rdev[id]);
			goto fail;
		}

		if (reg_data) {
			err = tps6586x_regulator_set_slew_rate(pdev, id,
					reg_data);
			if (err < 0) {
				dev_err(&pdev->dev,
					"Slew rate config failed, e %d\n", err);
				regulator_unregister(rdev[id]);
				goto fail;
			}
		}
	}

	platform_set_drvdata(pdev, rdev);
	return 0;

fail:
	while (--id >= 0)
		regulator_unregister(rdev[id]);
	return err;
}

static int __devexit tps6586x_regulator_remove(struct platform_device *pdev)
{
	struct regulator_dev **rdev = platform_get_drvdata(pdev);
	int id = TPS6586X_ID_MAX_REGULATOR;

	while (--id >= 0)
		regulator_unregister(rdev[id]);

	return 0;
}

static struct platform_driver tps6586x_regulator_driver = {
	.driver	= {
		.name	= "tps6586x-pmic",
		.owner	= THIS_MODULE,
	},
	.probe		= tps6586x_regulator_probe,
	.remove		= __devexit_p(tps6586x_regulator_remove),
};

static int __init tps6586x_regulator_init(void)
{
	return platform_driver_register(&tps6586x_regulator_driver);
}
subsys_initcall(tps6586x_regulator_init);

static void __exit tps6586x_regulator_exit(void)
{
	platform_driver_unregister(&tps6586x_regulator_driver);
}
module_exit(tps6586x_regulator_exit);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
MODULE_DESCRIPTION("Regulator Driver for TI TPS6586X PMIC");
MODULE_ALIAS("platform:tps6586x-regulator");
Commit	Line	Data
49610235 MR	1	/*
	2	* Regulator driver for TI TPS6586x
	3	*
	4	* Copyright (C) 2010 Compulab Ltd.
	5	* Author: Mike Rapoport <mike@compulab.co.il>
	6	*
	7	* Based on da903x
	8	* Copyright (C) 2006-2008 Marvell International Ltd.
	9	* Copyright (C) 2008 Compulab Ltd.
	10	*
	11	* This program is free software; you can redistribute it and/or modify
	12	* it under the terms of the GNU General Public License version 2 as
	13	* published by the Free Software Foundation.
	14	*/
	15
49610235	16	#include <linux/kernel.h>
65602c32	17	#include <linux/module.h>
49610235 MR	18	#include <linux/init.h>
49610235 MR	19	#include <linux/err.h>
64e48160	20	#include <linux/of.h>
49610235 MR	21	#include <linux/slab.h>
	22	#include <linux/platform_device.h>
	23	#include <linux/regulator/driver.h>
	24	#include <linux/regulator/machine.h>
64e48160	25	#include <linux/regulator/of_regulator.h>
49610235 MR	26	#include <linux/mfd/tps6586x.h>
	27
	28	/* supply control and voltage setting */
	29	#define TPS6586X_SUPPLYENA 0x10
	30	#define TPS6586X_SUPPLYENB 0x11
	31	#define TPS6586X_SUPPLYENC 0x12
	32	#define TPS6586X_SUPPLYEND 0x13
	33	#define TPS6586X_SUPPLYENE 0x14
	34	#define TPS6586X_VCC1 0x20
	35	#define TPS6586X_VCC2 0x21
	36	#define TPS6586X_SM1V1 0x23
	37	#define TPS6586X_SM1V2 0x24
	38	#define TPS6586X_SM1SL 0x25
	39	#define TPS6586X_SM0V1 0x26
	40	#define TPS6586X_SM0V2 0x27
	41	#define TPS6586X_SM0SL 0x28
	42	#define TPS6586X_LDO2AV1 0x29
	43	#define TPS6586X_LDO2AV2 0x2A
	44	#define TPS6586X_LDO2BV1 0x2F
	45	#define TPS6586X_LDO2BV2 0x30
	46	#define TPS6586X_LDO4V1 0x32
	47	#define TPS6586X_LDO4V2 0x33
	48
	49	/* converter settings */
	50	#define TPS6586X_SUPPLYV1 0x41
	51	#define TPS6586X_SUPPLYV2 0x42
	52	#define TPS6586X_SUPPLYV3 0x43
	53	#define TPS6586X_SUPPLYV4 0x44
	54	#define TPS6586X_SUPPLYV5 0x45
	55	#define TPS6586X_SUPPLYV6 0x46
	56	#define TPS6586X_SMODE1 0x47
	57	#define TPS6586X_SMODE2 0x48
	58
	59	struct tps6586x_regulator {
	60	struct regulator_desc desc;
	61
49610235 MR	62	int enable_bit[2];
	63	int enable_reg[2];
	64
49610235 MR	65	/* for DVM regulators */
	66	int go_reg;
	67	int go_bit;
	68	};
	69
	70	static inline struct device to_tps6586x_dev(struct regulator_dev rdev)
	71	{
7c7fac30	72	return rdev_get_dev(rdev)->parent;
49610235 MR	73	}
49610235 MR	74
eed06517 AL	75	static int tps6586x_set_voltage_sel(struct regulator_dev *rdev,
eed06517 AL	76	unsigned selector)
49610235	77	{
eed06517 AL	78	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	79	struct device *parent = to_tps6586x_dev(rdev);
	80	int ret, val, rid = rdev_get_id(rdev);
49610235 MR	81	uint8_t mask;
49610235 MR	82
7c7475c0 AL	83	val = selector << (ffs(rdev->desc->vsel_mask) - 1);
7c7475c0 AL	84	mask = rdev->desc->vsel_mask;
3a93f2a9	85
7c7475c0	86	ret = tps6586x_update(parent, rdev->desc->vsel_reg, val, mask);
eed06517 AL	87	if (ret)
eed06517 AL	88	return ret;
49610235	89
eed06517 AL	90	/* Update go bit for DVM regulators */
	91	switch (rid) {
	92	case TPS6586X_ID_LDO_2:
	93	case TPS6586X_ID_LDO_4:
	94	case TPS6586X_ID_SM_0:
	95	case TPS6586X_ID_SM_1:
	96	ret = tps6586x_set_bits(parent, ri->go_reg, 1 << ri->go_bit);
	97	break;
49610235	98	}
eed06517	99	return ret;
49610235 MR	100	}
49610235 MR	101
e1816235	102	static struct regulator_ops tps6586x_regulator_ops = {
f4647037	103	.list_voltage = regulator_list_voltage_table,
7c7475c0	104	.get_voltage_sel = regulator_get_voltage_sel_regmap,
eed06517	105	.set_voltage_sel = tps6586x_set_voltage_sel,
49610235	106
7c7475c0 AL	107	.is_enabled = regulator_is_enabled_regmap,
	108	.enable = regulator_enable_regmap,
	109	.disable = regulator_disable_regmap,
49610235 MR	110	};
49610235 MR	111
9394b80c	112	static struct regulator_ops tps6586x_sys_regulator_ops = {
49610235 MR	113	};
49610235 MR	114
f4647037 AL	115	static const unsigned int tps6586x_ldo0_voltages[] = {
	116	1200000, 1500000, 1800000, 2500000, 2700000, 2850000, 3100000, 3300000,
	117	};
	118
	119	static const unsigned int tps6586x_ldo4_voltages[] = {
	120	1700000, 1725000, 1750000, 1775000, 1800000, 1825000, 1850000, 1875000,
	121	1900000, 1925000, 1950000, 1975000, 2000000, 2025000, 2050000, 2075000,
	122	2100000, 2125000, 2150000, 2175000, 2200000, 2225000, 2250000, 2275000,
	123	2300000, 2325000, 2350000, 2375000, 2400000, 2425000, 2450000, 2475000,
49610235 MR	124	};
49610235 MR	125
f4647037 AL	126	static const unsigned int tps6586x_ldo_voltages[] = {
f4647037 AL	127	1250000, 1500000, 1800000, 2500000, 2700000, 2850000, 3100000, 3300000,
49610235 MR	128	};
49610235 MR	129
f4647037 AL	130	static const unsigned int tps6586x_sm2_voltages[] = {
	131	3000000, 3050000, 3100000, 3150000, 3200000, 3250000, 3300000, 3350000,
	132	3400000, 3450000, 3500000, 3550000, 3600000, 3650000, 3700000, 3750000,
	133	3800000, 3850000, 3900000, 3950000, 4000000, 4050000, 4100000, 4150000,
	134	4200000, 4250000, 4300000, 4350000, 4400000, 4450000, 4500000, 4550000,
4cc2e393 GK	135	};
4cc2e393 GK	136
f4647037 AL	137	static const unsigned int tps6586x_dvm_voltages[] = {
	138	725000, 750000, 775000, 800000, 825000, 850000, 875000, 900000,
	139	925000, 950000, 975000, 1000000, 1025000, 1050000, 1075000, 1100000,
	140	1125000, 1150000, 1175000, 1200000, 1225000, 1250000, 1275000, 1300000,
	141	1325000, 1350000, 1375000, 1400000, 1425000, 1450000, 1475000, 1500000,
49610235 MR	142	};
49610235 MR	143
7c7fac30	144	#define TPS6586X_REGULATOR(_id, _pin_name, vdata, vreg, shift, nbits, \
64db657b	145	ereg0, ebit0, ereg1, ebit1) \
49610235	146	.desc = { \
7c7fac30	147	.supply_name = _pin_name, \
49610235	148	.name = "REG-" #_id, \
e1816235	149	.ops = &tps6586x_regulator_ops, \
49610235 MR	150	.type = REGULATOR_VOLTAGE, \
	151	.id = TPS6586X_ID_##_id, \
	152	.n_voltages = ARRAY_SIZE(tps6586x_##vdata##_voltages), \
f4647037	153	.volt_table = tps6586x_##vdata##_voltages, \
49610235	154	.owner = THIS_MODULE, \
7c7475c0 AL	155	.enable_reg = TPS6586X_SUPPLY##ereg0, \
	156	.enable_mask = 1 << (ebit0), \
	157	.vsel_reg = TPS6586X_##vreg, \
	158	.vsel_mask = ((1 << (nbits)) - 1) << (shift), \
49610235	159	}, \
49610235 MR	160	.enable_reg[0] = TPS6586X_SUPPLY##ereg0, \
	161	.enable_bit[0] = (ebit0), \
	162	.enable_reg[1] = TPS6586X_SUPPLY##ereg1, \
f4647037	163	.enable_bit[1] = (ebit1),
64db657b DH	164
	165	#define TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit) \
	166	.go_reg = TPS6586X_##goreg, \
	167	.go_bit = (gobit),
49610235	168
7c7fac30	169	#define TPS6586X_LDO(_id, _pname, vdata, vreg, shift, nbits, \
49610235	170	ereg0, ebit0, ereg1, ebit1) \
64db657b	171	{ \
7c7fac30	172	TPS6586X_REGULATOR(_id, _pname, vdata, vreg, shift, nbits, \
64db657b DH	173	ereg0, ebit0, ereg1, ebit1) \
64db657b DH	174	}
49610235	175
7c7fac30	176	#define TPS6586X_DVM(_id, _pname, vdata, vreg, shift, nbits, \
49610235	177	ereg0, ebit0, ereg1, ebit1, goreg, gobit) \
64db657b	178	{ \
7c7fac30	179	TPS6586X_REGULATOR(_id, _pname, vdata, vreg, shift, nbits, \
64db657b DH	180	ereg0, ebit0, ereg1, ebit1) \
	181	TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit) \
	182	}
49610235	183
9394b80c LD	184	#define TPS6586X_SYS_REGULATOR() \
	185	{ \
	186	.desc = { \
	187	.supply_name = "sys", \
	188	.name = "REG-SYS", \
	189	.ops = &tps6586x_sys_regulator_ops, \
	190	.type = REGULATOR_VOLTAGE, \
	191	.id = TPS6586X_ID_SYS, \
	192	.owner = THIS_MODULE, \
	193	}, \
	194	}
	195
49610235	196	static struct tps6586x_regulator tps6586x_regulator[] = {
9394b80c	197	TPS6586X_SYS_REGULATOR(),
7c7fac30 LD	198	TPS6586X_LDO(LDO_0, "vinldo01", ldo0, SUPPLYV1, 5, 3, ENC, 0, END, 0),
7c7fac30 LD	199	TPS6586X_LDO(LDO_3, "vinldo23", ldo, SUPPLYV4, 0, 3, ENC, 2, END, 2),
9394b80c	200	TPS6586X_LDO(LDO_5, "REG-SYS", ldo, SUPPLYV6, 0, 3, ENE, 6, ENE, 6),
7c7fac30 LD	201	TPS6586X_LDO(LDO_6, "vinldo678", ldo, SUPPLYV3, 0, 3, ENC, 4, END, 4),
	202	TPS6586X_LDO(LDO_7, "vinldo678", ldo, SUPPLYV3, 3, 3, ENC, 5, END, 5),
	203	TPS6586X_LDO(LDO_8, "vinldo678", ldo, SUPPLYV2, 5, 3, ENC, 6, END, 6),
	204	TPS6586X_LDO(LDO_9, "vinldo9", ldo, SUPPLYV6, 3, 3, ENE, 7, ENE, 7),
9394b80c	205	TPS6586X_LDO(LDO_RTC, "REG-SYS", ldo, SUPPLYV4, 3, 3, V4, 7, V4, 7),
7c7fac30	206	TPS6586X_LDO(LDO_1, "vinldo01", dvm, SUPPLYV1, 0, 5, ENC, 1, END, 1),
7f852e05	207	TPS6586X_LDO(SM_2, "vin-sm2", sm2, SUPPLYV2, 0, 5, ENC, 7, END, 7),
7c7fac30 LD	208
	209	TPS6586X_DVM(LDO_2, "vinldo23", dvm, LDO2BV1, 0, 5, ENA, 3,
	210	ENB, 3, VCC2, 6),
	211	TPS6586X_DVM(LDO_4, "vinldo4", ldo4, LDO4V1, 0, 5, ENC, 3,
	212	END, 3, VCC1, 6),
7f852e05 LD	213	TPS6586X_DVM(SM_0, "vin-sm0", dvm, SM0V1, 0, 5, ENA, 1,
	214	ENB, 1, VCC1, 2),
	215	TPS6586X_DVM(SM_1, "vin-sm1", dvm, SM1V1, 0, 5, ENA, 0,
	216	ENB, 0, VCC1, 0),
49610235 MR	217	};
	218
	219	/*
	220	* TPS6586X has 2 enable bits that are OR'ed to determine the actual
	221	* regulator state. Clearing one of this bits allows switching
	222	* regulator on and of with single register write.
	223	*/
	224	static inline int tps6586x_regulator_preinit(struct device *parent,
	225	struct tps6586x_regulator *ri)
	226	{
	227	uint8_t val1, val2;
	228	int ret;
	229
1dbcf35c DH	230	if (ri->enable_reg[0] == ri->enable_reg[1] &&
	231	ri->enable_bit[0] == ri->enable_bit[1])
	232	return 0;
	233
49610235 MR	234	ret = tps6586x_read(parent, ri->enable_reg[0], &val1);
	235	if (ret)
	236	return ret;
	237
	238	ret = tps6586x_read(parent, ri->enable_reg[1], &val2);
	239	if (ret)
	240	return ret;
	241
4f586707	242	if (!(val2 & (1 << ri->enable_bit[1])))
49610235 MR	243	return 0;
	244
	245	/*
	246	* The regulator is on, but it's enabled with the bit we don't
	247	* want to use, so we switch the enable bits
	248	*/
4f586707	249	if (!(val1 & (1 << ri->enable_bit[0]))) {
49610235 MR	250	ret = tps6586x_set_bits(parent, ri->enable_reg[0],
	251	1 << ri->enable_bit[0]);
	252	if (ret)
	253	return ret;
	254	}
	255
	256	return tps6586x_clr_bits(parent, ri->enable_reg[1],
	257	1 << ri->enable_bit[1]);
	258	}
	259
64e48160 LD	260	static int tps6586x_regulator_set_slew_rate(struct platform_device *pdev,
64e48160 LD	261	int id, struct regulator_init_data *p)
500c524a XX	262	{
500c524a XX	263	struct device *parent = pdev->dev.parent;
500c524a XX	264	struct tps6586x_settings *setting = p->driver_data;
	265	uint8_t reg;
	266
	267	if (setting == NULL)
	268	return 0;
	269
	270	if (!(setting->slew_rate & TPS6586X_SLEW_RATE_SET))
	271	return 0;
	272
	273	/* only SM0 and SM1 can have the slew rate settings */
64e48160	274	switch (id) {
500c524a XX	275	case TPS6586X_ID_SM_0:
	276	reg = TPS6586X_SM0SL;
	277	break;
	278	case TPS6586X_ID_SM_1:
	279	reg = TPS6586X_SM1SL;
	280	break;
	281	default:
	282	dev_warn(&pdev->dev, "Only SM0/SM1 can set slew rate\n");
	283	return -EINVAL;
	284	}
	285
	286	return tps6586x_write(parent, reg,
	287	setting->slew_rate & TPS6586X_SLEW_RATE_MASK);
	288	}
	289
49610235 MR	290	static inline struct tps6586x_regulator *find_regulator_info(int id)
	291	{
	292	struct tps6586x_regulator *ri;
	293	int i;
	294
	295	for (i = 0; i < ARRAY_SIZE(tps6586x_regulator); i++) {
	296	ri = &tps6586x_regulator[i];
	297	if (ri->desc.id == id)
	298	return ri;
	299	}
	300	return NULL;
	301	}
	302
64e48160 LD	303	#ifdef CONFIG_OF
	304	static struct of_regulator_match tps6586x_matches[] = {
	305	{ .name = "sys", .driver_data = (void *)TPS6586X_ID_SYS },
	306	{ .name = "sm0", .driver_data = (void *)TPS6586X_ID_SM_0 },
	307	{ .name = "sm1", .driver_data = (void *)TPS6586X_ID_SM_1 },
	308	{ .name = "sm2", .driver_data = (void *)TPS6586X_ID_SM_2 },
	309	{ .name = "ldo0", .driver_data = (void *)TPS6586X_ID_LDO_0 },
	310	{ .name = "ldo1", .driver_data = (void *)TPS6586X_ID_LDO_1 },
	311	{ .name = "ldo2", .driver_data = (void *)TPS6586X_ID_LDO_2 },
	312	{ .name = "ldo3", .driver_data = (void *)TPS6586X_ID_LDO_3 },
	313	{ .name = "ldo4", .driver_data = (void *)TPS6586X_ID_LDO_4 },
	314	{ .name = "ldo5", .driver_data = (void *)TPS6586X_ID_LDO_5 },
	315	{ .name = "ldo6", .driver_data = (void *)TPS6586X_ID_LDO_6 },
	316	{ .name = "ldo7", .driver_data = (void *)TPS6586X_ID_LDO_7 },
	317	{ .name = "ldo8", .driver_data = (void *)TPS6586X_ID_LDO_8 },
	318	{ .name = "ldo9", .driver_data = (void *)TPS6586X_ID_LDO_9 },
	319	{ .name = "ldo_rtc", .driver_data = (void *)TPS6586X_ID_LDO_RTC },
	320	};
	321
	322	static struct tps6586x_platform_data *tps6586x_parse_regulator_dt(
	323	struct platform_device *pdev,
	324	struct of_regulator_match **tps6586x_reg_matches)
	325	{
	326	const unsigned int num = ARRAY_SIZE(tps6586x_matches);
	327	struct device_node *np = pdev->dev.parent->of_node;
	328	struct device_node *regs;
	329	const char *sys_rail = NULL;
	330	unsigned int i;
	331	struct tps6586x_platform_data *pdata;
	332	int err;
	333
	334	regs = of_find_node_by_name(np, "regulators");
	335	if (!regs) {
	336	dev_err(&pdev->dev, "regulator node not found\n");
	337	return NULL;
	338	}
	339
	340	err = of_regulator_match(&pdev->dev, regs, tps6586x_matches, num);
	341	if (err < 0) {
	342	dev_err(&pdev->dev, "Regulator match failed, e %d\n", err);
	343	of_node_put(regs);
	344	return NULL;
	345	}
	346
	347	of_node_put(regs);
	348
	349	pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
	350	if (!pdata) {
	351	dev_err(&pdev->dev, "Memory alloction failed\n");
	352	return NULL;
	353	}
	354
	355	for (i = 0; i < num; i++) {
	356	int id;
	357	if (!tps6586x_matches[i].init_data)
	358	continue;
	359
	360	pdata->reg_init_data[i] = tps6586x_matches[i].init_data;
	361	id = (int)tps6586x_matches[i].driver_data;
	362	if (id == TPS6586X_ID_SYS)
	363	sys_rail = pdata->reg_init_data[i]->constraints.name;
	364
	365	if ((id == TPS6586X_ID_LDO_5) \|\| (id == TPS6586X_ID_LDO_RTC))
	366	pdata->reg_init_data[i]->supply_regulator = sys_rail;
367	}
368	*tps6586x_reg_matches = tps6586x_matches;
369	return pdata;
370	}
371	#else
372	static struct tps6586x_platform_data *tps6586x_parse_regulator_dt(
373	struct platform_device *pdev,
374	struct of_regulator_match **tps6586x_reg_matches)
375	{
376	*tps6586x_reg_matches = NULL;
377	return NULL;
378	}
379	#endif
380
49610235 MR	381	static int __devinit tps6586x_regulator_probe(struct platform_device *pdev)
	382	{
	383	struct tps6586x_regulator *ri = NULL;
c172708d	384	struct regulator_config config = { };
64e48160 LD	385	struct regulator_dev **rdev;
	386	struct regulator_init_data *reg_data;
	387	struct tps6586x_platform_data *pdata;
	388	struct of_regulator_match *tps6586x_reg_matches = NULL;
	389	int id;
49610235 MR	390	int err;
49610235 MR	391
10835600	392	dev_dbg(&pdev->dev, "Probing regulator\n");
49610235	393
64e48160 LD	394	pdata = dev_get_platdata(pdev->dev.parent);
	395	if ((!pdata) && (pdev->dev.parent->of_node))
	396	pdata = tps6586x_parse_regulator_dt(pdev,
	397	&tps6586x_reg_matches);
49610235	398
64e48160 LD	399	if (!pdata) {
	400	dev_err(&pdev->dev, "Platform data not available, exiting\n");
	401	return -ENODEV;
	402	}
49610235	403
64e48160 LD	404	rdev = devm_kzalloc(&pdev->dev, TPS6586X_ID_MAX_REGULATOR *
	405	sizeof(*rdev), GFP_KERNEL);
	406	if (!rdev) {
	407	dev_err(&pdev->dev, "Mmemory alloc failed\n");
	408	return -ENOMEM;
	409	}
c172708d	410
64e48160 LD	411	for (id = 0; id < TPS6586X_ID_MAX_REGULATOR; ++id) {
	412	reg_data = pdata->reg_init_data[id];
	413
	414	ri = find_regulator_info(id);
	415	if (!ri) {
	416	dev_err(&pdev->dev, "invalid regulator ID specified\n");
	417	err = -EINVAL;
	418	goto fail;
	419	}
	420
	421	err = tps6586x_regulator_preinit(pdev->dev.parent, ri);
	422	if (err) {
	423	dev_err(&pdev->dev,
	424	"regulator %d preinit failed, e %d\n", id, err);
	425	goto fail;
	426	}
	427
	428	config.dev = pdev->dev.parent;
	429	config.init_data = reg_data;
	430	config.driver_data = ri;
	431
	432	if (tps6586x_reg_matches)
	433	config.of_node = tps6586x_reg_matches[id].of_node;
	434
	435	rdev[id] = regulator_register(&ri->desc, &config);
	436	if (IS_ERR(rdev[id])) {
	437	dev_err(&pdev->dev, "failed to register regulator %s\n",
	438	ri->desc.name);
	439	err = PTR_ERR(rdev[id]);
	440	goto fail;
	441	}
	442
	443	if (reg_data) {
	444	err = tps6586x_regulator_set_slew_rate(pdev, id,
	445	reg_data);
	446	if (err < 0) {
	447	dev_err(&pdev->dev,
	448	"Slew rate config failed, e %d\n", err);
	449	regulator_unregister(rdev[id]);
	450	goto fail;
	451	}
	452	}
49610235 MR	453	}
49610235 MR	454
e7973c3c	455	platform_set_drvdata(pdev, rdev);
64e48160	456	return 0;
49610235	457
64e48160 LD	458	fail:
	459	while (--id >= 0)
	460	regulator_unregister(rdev[id]);
	461	return err;
49610235 MR	462	}
	463
	464	static int __devexit tps6586x_regulator_remove(struct platform_device *pdev)
	465	{
64e48160 LD	466	struct regulator_dev **rdev = platform_get_drvdata(pdev);
	467	int id = TPS6586X_ID_MAX_REGULATOR;
	468
	469	while (--id >= 0)
	470	regulator_unregister(rdev[id]);
e7973c3c	471
49610235 MR	472	return 0;
	473	}
	474
	475	static struct platform_driver tps6586x_regulator_driver = {
	476	.driver = {
64e48160	477	.name = "tps6586x-pmic",
49610235 MR	478	.owner = THIS_MODULE,
	479	},
	480	.probe = tps6586x_regulator_probe,
	481	.remove = __devexit_p(tps6586x_regulator_remove),
	482	};
	483
	484	static int __init tps6586x_regulator_init(void)
	485	{
	486	return platform_driver_register(&tps6586x_regulator_driver);
	487	}
	488	subsys_initcall(tps6586x_regulator_init);
	489
	490	static void __exit tps6586x_regulator_exit(void)
	491	{
	492	platform_driver_unregister(&tps6586x_regulator_driver);
	493	}
	494	module_exit(tps6586x_regulator_exit);
	495
	496	MODULE_LICENSE("GPL");
	497	MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
	498	MODULE_DESCRIPTION("Regulator Driver for TI TPS6586X PMIC");
	499	MODULE_ALIAS("platform:tps6586x-regulator");