[deliverable/linux.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/init.h>
#include <linux/err.h>
#include <linux/slab.h>
#include <linux/platform_device.h>
#include <linux/regulator/driver.h>
#include <linux/regulator/machine.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 volt_reg;
	int volt_shift;
	int volt_nbits;
	int enable_bit[2];
	int enable_reg[2];

	int *voltages;

	/* 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->parent;
}

static int tps6586x_ldo_list_voltage(struct regulator_dev *rdev,
				     unsigned selector)
{
	struct tps6586x_regulator *info = rdev_get_drvdata(rdev);

	return info->voltages[selector] * 1000;
}


static int __tps6586x_ldo_set_voltage(struct device *parent,
				      struct tps6586x_regulator *ri,
				      int min_uV, int max_uV)
{
	int val, uV;
	uint8_t mask;

	for (val = 0; val < ri->desc.n_voltages; val++) {
		uV = ri->voltages[val] * 1000;

		/* LDO0 has minimal voltage 1.2 rather than 1.25 */
		if (ri->desc.id == TPS6586X_ID_LDO_0 && val == 0)
			uV -= 50 * 1000;

		/* use the first in-range value */
		if (min_uV <= uV && uV <= max_uV) {

			val <<= ri->volt_shift;
			mask = ((1 << ri->volt_nbits) - 1) << ri->volt_shift;

			return tps6586x_update(parent, ri->volt_reg, val, mask);
		}
	}

	return -EINVAL;
}

static int tps6586x_ldo_set_voltage(struct regulator_dev *rdev,
				    int min_uV, int max_uV)
{
	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	struct device *parent = to_tps6586x_dev(rdev);

	return __tps6586x_ldo_set_voltage(parent, ri, min_uV, max_uV);
}

static int tps6586x_ldo_get_voltage(struct regulator_dev *rdev)
{
	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	struct device *parent = to_tps6586x_dev(rdev);
	uint8_t val, mask;
	int ret;

	ret = tps6586x_read(parent, ri->volt_reg, &val);
	if (ret)
		return ret;

	mask = ((1 << ri->volt_nbits) - 1) << ri->volt_shift;
	val = (val & mask) >> ri->volt_shift;

	if (val >= ri->desc.n_voltages)
		BUG();

	return ri->voltages[val] * 1000;
}

static int tps6586x_dvm_set_voltage(struct regulator_dev *rdev,
				    int min_uV, int max_uV)
{
	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	struct device *parent = to_tps6586x_dev(rdev);
	int ret;

	ret = __tps6586x_ldo_set_voltage(parent, ri, min_uV, max_uV);
	if (ret)
		return ret;

	return tps6586x_set_bits(parent, ri->go_reg, 1 << ri->go_bit);
}

static int tps6586x_regulator_enable(struct regulator_dev *rdev)
{
	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	struct device *parent = to_tps6586x_dev(rdev);

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

static int tps6586x_regulator_disable(struct regulator_dev *rdev)
{
	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	struct device *parent = to_tps6586x_dev(rdev);

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

static int tps6586x_regulator_is_enabled(struct regulator_dev *rdev)
{
	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	struct device *parent = to_tps6586x_dev(rdev);
	uint8_t reg_val;
	int ret;

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

	return !!(reg_val & (1 << ri->enable_bit[0]));
}

static struct regulator_ops tps6586x_regulator_ldo_ops = {
	.list_voltage = tps6586x_ldo_list_voltage,
	.get_voltage = tps6586x_ldo_get_voltage,
	.set_voltage = tps6586x_ldo_set_voltage,

	.is_enabled = tps6586x_regulator_is_enabled,
	.enable = tps6586x_regulator_enable,
	.disable = tps6586x_regulator_disable,
};

static struct regulator_ops tps6586x_regulator_dvm_ops = {
	.list_voltage = tps6586x_ldo_list_voltage,
	.get_voltage = tps6586x_ldo_get_voltage,
	.set_voltage = tps6586x_dvm_set_voltage,

	.is_enabled = tps6586x_regulator_is_enabled,
	.enable = tps6586x_regulator_enable,
	.disable = tps6586x_regulator_disable,
};

static int tps6586x_ldo_voltages[] = {
	1250, 1500, 1800, 2500, 2700, 2850, 3100, 3300,
};

static int tps6586x_ldo4_voltages[] = {
	1700, 1725, 1750, 1775, 1800, 1825, 1850, 1875,
	1900, 1925, 1950, 1975, 2000, 2025, 2050, 2075,
	2100, 2125, 2150, 2175, 2200, 2225, 2250, 2275,
	2300, 2325, 2350, 2375, 2400, 2425, 2450, 2475,
};

static int tps6586x_sm2_voltages[] = {
	3000, 3050, 3100, 3150, 3200, 3250, 3300, 3350,
	3400, 3450, 3500, 3550, 3600, 3650, 3700, 3750,
	3800, 3850, 3900, 3950, 4000, 4050, 4100, 4150,
	4200, 4250, 4300, 4350, 4400, 4450, 4500, 4550,
};

static int tps6586x_dvm_voltages[] = {
	 725,  750,  775,  800,  825,  850,  875,  900,
	 925,  950,  975, 1000, 1025, 1050, 1075, 1100,
	1125, 1150, 1175, 1200, 1225, 1250, 1275, 1300,
	1325, 1350, 1375, 1400, 1425, 1450, 1475, 1500,
};

#define TPS6586X_REGULATOR(_id, vdata, _ops, vreg, shift, nbits,	\
			   ereg0, ebit0, ereg1, ebit1)			\
	.desc	= {							\
		.name	= "REG-" #_id,					\
		.ops	= &tps6586x_regulator_##_ops,			\
		.type	= REGULATOR_VOLTAGE,				\
		.id	= TPS6586X_ID_##_id,				\
		.n_voltages = ARRAY_SIZE(tps6586x_##vdata##_voltages),	\
		.owner	= THIS_MODULE,					\
	},								\
	.volt_reg	= TPS6586X_##vreg,				\
	.volt_shift	= (shift),					\
	.volt_nbits	= (nbits),					\
	.enable_reg[0]	= TPS6586X_SUPPLY##ereg0,			\
	.enable_bit[0]	= (ebit0),					\
	.enable_reg[1]	= TPS6586X_SUPPLY##ereg1,			\
	.enable_bit[1]	= (ebit1),					\
	.voltages	= tps6586x_##vdata##_voltages,

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

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

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

static struct tps6586x_regulator tps6586x_regulator[] = {
	TPS6586X_LDO(LDO_0, ldo, SUPPLYV1, 5, 3, ENC, 0, END, 0),
	TPS6586X_LDO(LDO_3, ldo, SUPPLYV4, 0, 3, ENC, 2, END, 2),
	TPS6586X_LDO(LDO_5, ldo, SUPPLYV6, 0, 3, ENE, 6, ENE, 6),
	TPS6586X_LDO(LDO_6, ldo, SUPPLYV3, 0, 3, ENC, 4, END, 4),
	TPS6586X_LDO(LDO_7, ldo, SUPPLYV3, 3, 3, ENC, 5, END, 5),
	TPS6586X_LDO(LDO_8, ldo, SUPPLYV1, 5, 3, ENC, 6, END, 6),
	TPS6586X_LDO(LDO_9, ldo, SUPPLYV6, 3, 3, ENE, 7, ENE, 7),
	TPS6586X_LDO(LDO_RTC, ldo, SUPPLYV4, 3, 3, ENE, 7, ENE, 7),
	TPS6586X_LDO(LDO_1, dvm, SUPPLYV1, 0, 5, ENC, 1, END, 1),
	TPS6586X_LDO(SM_2, sm2, SUPPLYV2, 0, 5, ENC, 1, END, 1),

	TPS6586X_DVM(LDO_2, dvm, LDO2BV1, 0, 5, ENA, 3, ENB, 3, VCC2, 6),
	TPS6586X_DVM(LDO_4, ldo4, LDO4V1, 0, 5, ENC, 3, END, 3, VCC1, 6),
	TPS6586X_DVM(SM_0, dvm, SM0V1, 0, 5, ENA, 1, ENB, 1, VCC1, 2),
	TPS6586X_DVM(SM_1, 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;

	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 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;
}

static int __devinit tps6586x_regulator_probe(struct platform_device *pdev)
{
	struct tps6586x_regulator *ri = NULL;
	struct regulator_dev *rdev;
	int id = pdev->id;
	int err;

	dev_dbg(&pdev->dev, "Probing reulator %d\n", id);

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

	err = tps6586x_regulator_preinit(pdev->dev.parent, ri);
	if (err)
		return err;

	rdev = regulator_register(&ri->desc, &pdev->dev,
				  pdev->dev.platform_data, ri);
	if (IS_ERR(rdev)) {
		dev_err(&pdev->dev, "failed to register regulator %s\n",
				ri->desc.name);
		return PTR_ERR(rdev);
	}

	platform_set_drvdata(pdev, rdev);

	return 0;
}

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

	regulator_unregister(rdev);
	return 0;
}

static struct platform_driver tps6586x_regulator_driver = {
	.driver	= {
		.name	= "tps6586x-regulator",
		.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 MR	16	#include <linux/kernel.h>
	17	#include <linux/init.h>
	18	#include <linux/err.h>
	19	#include <linux/slab.h>
	20	#include <linux/platform_device.h>
	21	#include <linux/regulator/driver.h>
	22	#include <linux/regulator/machine.h>
	23	#include <linux/mfd/tps6586x.h>
	24
	25	/* supply control and voltage setting */
	26	#define TPS6586X_SUPPLYENA 0x10
	27	#define TPS6586X_SUPPLYENB 0x11
	28	#define TPS6586X_SUPPLYENC 0x12
	29	#define TPS6586X_SUPPLYEND 0x13
	30	#define TPS6586X_SUPPLYENE 0x14
	31	#define TPS6586X_VCC1 0x20
	32	#define TPS6586X_VCC2 0x21
	33	#define TPS6586X_SM1V1 0x23
	34	#define TPS6586X_SM1V2 0x24
	35	#define TPS6586X_SM1SL 0x25
	36	#define TPS6586X_SM0V1 0x26
	37	#define TPS6586X_SM0V2 0x27
	38	#define TPS6586X_SM0SL 0x28
	39	#define TPS6586X_LDO2AV1 0x29
	40	#define TPS6586X_LDO2AV2 0x2A
	41	#define TPS6586X_LDO2BV1 0x2F
	42	#define TPS6586X_LDO2BV2 0x30
	43	#define TPS6586X_LDO4V1 0x32
	44	#define TPS6586X_LDO4V2 0x33
	45
	46	/* converter settings */
	47	#define TPS6586X_SUPPLYV1 0x41
	48	#define TPS6586X_SUPPLYV2 0x42
	49	#define TPS6586X_SUPPLYV3 0x43
	50	#define TPS6586X_SUPPLYV4 0x44
	51	#define TPS6586X_SUPPLYV5 0x45
	52	#define TPS6586X_SUPPLYV6 0x46
	53	#define TPS6586X_SMODE1 0x47
	54	#define TPS6586X_SMODE2 0x48
	55
	56	struct tps6586x_regulator {
	57	struct regulator_desc desc;
	58
	59	int volt_reg;
	60	int volt_shift;
	61	int volt_nbits;
	62	int enable_bit[2];
	63	int enable_reg[2];
	64
	65	int *voltages;
	66
	67	/* for DVM regulators */
	68	int go_reg;
	69	int go_bit;
	70	};
	71
	72	static inline struct device to_tps6586x_dev(struct regulator_dev rdev)
	73	{
	74	return rdev_get_dev(rdev)->parent->parent;
	75	}
	76
	77	static int tps6586x_ldo_list_voltage(struct regulator_dev *rdev,
	78	unsigned selector)
	79	{
80	struct tps6586x_regulator *info = rdev_get_drvdata(rdev);
81
4cc2e393	82	return info->voltages[selector] * 1000;
49610235 MR	83	}
	84
	85
	86	static int __tps6586x_ldo_set_voltage(struct device *parent,
	87	struct tps6586x_regulator *ri,
	88	int min_uV, int max_uV)
	89	{
	90	int val, uV;
	91	uint8_t mask;
	92
	93	for (val = 0; val < ri->desc.n_voltages; val++) {
	94	uV = ri->voltages[val] * 1000;
	95
	96	/* LDO0 has minimal voltage 1.2 rather than 1.25 */
	97	if (ri->desc.id == TPS6586X_ID_LDO_0 && val == 0)
	98	uV -= 50 * 1000;
	99
	100	/* use the first in-range value */
	101	if (min_uV <= uV && uV <= max_uV) {
	102
	103	val <<= ri->volt_shift;
	104	mask = ((1 << ri->volt_nbits) - 1) << ri->volt_shift;
	105
	106	return tps6586x_update(parent, ri->volt_reg, val, mask);
	107	}
	108	}
	109
	110	return -EINVAL;
	111	}
	112
	113	static int tps6586x_ldo_set_voltage(struct regulator_dev *rdev,
	114	int min_uV, int max_uV)
	115	{
	116	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	117	struct device *parent = to_tps6586x_dev(rdev);
	118
	119	return __tps6586x_ldo_set_voltage(parent, ri, min_uV, max_uV);
	120	}
	121
	122	static int tps6586x_ldo_get_voltage(struct regulator_dev *rdev)
	123	{
	124	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	125	struct device *parent = to_tps6586x_dev(rdev);
	126	uint8_t val, mask;
	127	int ret;
	128
	129	ret = tps6586x_read(parent, ri->volt_reg, &val);
	130	if (ret)
	131	return ret;
	132
	133	mask = ((1 << ri->volt_nbits) - 1) << ri->volt_shift;
	134	val = (val & mask) >> ri->volt_shift;
	135
327531ba	136	if (val >= ri->desc.n_voltages)
49610235 MR	137	BUG();
49610235 MR	138
4cc2e393	139	return ri->voltages[val] * 1000;
49610235 MR	140	}
	141
	142	static int tps6586x_dvm_set_voltage(struct regulator_dev *rdev,
	143	int min_uV, int max_uV)
	144	{
	145	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	146	struct device *parent = to_tps6586x_dev(rdev);
	147	int ret;
	148
	149	ret = __tps6586x_ldo_set_voltage(parent, ri, min_uV, max_uV);
	150	if (ret)
	151	return ret;
	152
938b4592	153	return tps6586x_set_bits(parent, ri->go_reg, 1 << ri->go_bit);
49610235 MR	154	}
	155
	156	static int tps6586x_regulator_enable(struct regulator_dev *rdev)
	157	{
	158	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	159	struct device *parent = to_tps6586x_dev(rdev);
	160
	161	return tps6586x_set_bits(parent, ri->enable_reg[0],
	162	1 << ri->enable_bit[0]);
	163	}
	164
	165	static int tps6586x_regulator_disable(struct regulator_dev *rdev)
	166	{
	167	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	168	struct device *parent = to_tps6586x_dev(rdev);
	169
	170	return tps6586x_clr_bits(parent, ri->enable_reg[0],
	171	1 << ri->enable_bit[0]);
	172	}
	173
	174	static int tps6586x_regulator_is_enabled(struct regulator_dev *rdev)
	175	{
	176	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	177	struct device *parent = to_tps6586x_dev(rdev);
	178	uint8_t reg_val;
	179	int ret;
	180
	181	ret = tps6586x_read(parent, ri->enable_reg[0], &reg_val);
	182	if (ret)
	183	return ret;
	184
	185	return !!(reg_val & (1 << ri->enable_bit[0]));
	186	}
	187
	188	static struct regulator_ops tps6586x_regulator_ldo_ops = {
	189	.list_voltage = tps6586x_ldo_list_voltage,
	190	.get_voltage = tps6586x_ldo_get_voltage,
	191	.set_voltage = tps6586x_ldo_set_voltage,
	192
	193	.is_enabled = tps6586x_regulator_is_enabled,
	194	.enable = tps6586x_regulator_enable,
	195	.disable = tps6586x_regulator_disable,
	196	};
	197
	198	static struct regulator_ops tps6586x_regulator_dvm_ops = {
	199	.list_voltage = tps6586x_ldo_list_voltage,
	200	.get_voltage = tps6586x_ldo_get_voltage,
	201	.set_voltage = tps6586x_dvm_set_voltage,
	202
	203	.is_enabled = tps6586x_regulator_is_enabled,
	204	.enable = tps6586x_regulator_enable,
	205	.disable = tps6586x_regulator_disable,
	206	};
	207
	208	static int tps6586x_ldo_voltages[] = {
	209	1250, 1500, 1800, 2500, 2700, 2850, 3100, 3300,
	210	};
	211
	212	static int tps6586x_ldo4_voltages[] = {
	213	1700, 1725, 1750, 1775, 1800, 1825, 1850, 1875,
	214	1900, 1925, 1950, 1975, 2000, 2025, 2050, 2075,
	215	2100, 2125, 2150, 2175, 2200, 2225, 2250, 2275,
	216	2300, 2325, 2350, 2375, 2400, 2425, 2450, 2475,
	217	};
218
4cc2e393 GK	219	static int tps6586x_sm2_voltages[] = {
	220	3000, 3050, 3100, 3150, 3200, 3250, 3300, 3350,
	221	3400, 3450, 3500, 3550, 3600, 3650, 3700, 3750,
	222	3800, 3850, 3900, 3950, 4000, 4050, 4100, 4150,
	223	4200, 4250, 4300, 4350, 4400, 4450, 4500, 4550,
	224	};
	225
49610235 MR	226	static int tps6586x_dvm_voltages[] = {
	227	725, 750, 775, 800, 825, 850, 875, 900,
	228	925, 950, 975, 1000, 1025, 1050, 1075, 1100,
	229	1125, 1150, 1175, 1200, 1225, 1250, 1275, 1300,
	230	1325, 1350, 1375, 1400, 1425, 1450, 1475, 1500,
	231	};
	232
	233	#define TPS6586X_REGULATOR(_id, vdata, _ops, vreg, shift, nbits, \
64db657b	234	ereg0, ebit0, ereg1, ebit1) \
49610235 MR	235	.desc = { \
	236	.name = "REG-" #_id, \
	237	.ops = &tps6586x_regulator_##_ops, \
	238	.type = REGULATOR_VOLTAGE, \
	239	.id = TPS6586X_ID_##_id, \
	240	.n_voltages = ARRAY_SIZE(tps6586x_##vdata##_voltages), \
	241	.owner = THIS_MODULE, \
	242	}, \
	243	.volt_reg = TPS6586X_##vreg, \
	244	.volt_shift = (shift), \
	245	.volt_nbits = (nbits), \
	246	.enable_reg[0] = TPS6586X_SUPPLY##ereg0, \
	247	.enable_bit[0] = (ebit0), \
	248	.enable_reg[1] = TPS6586X_SUPPLY##ereg1, \
	249	.enable_bit[1] = (ebit1), \
64db657b DH	250	.voltages = tps6586x_##vdata##_voltages,
	251
	252	#define TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit) \
	253	.go_reg = TPS6586X_##goreg, \
	254	.go_bit = (gobit),
49610235 MR	255
	256	#define TPS6586X_LDO(_id, vdata, vreg, shift, nbits, \
	257	ereg0, ebit0, ereg1, ebit1) \
64db657b	258	{ \
49610235	259	TPS6586X_REGULATOR(_id, vdata, ldo_ops, vreg, shift, nbits, \
64db657b DH	260	ereg0, ebit0, ereg1, ebit1) \
64db657b DH	261	}
49610235 MR	262
	263	#define TPS6586X_DVM(_id, vdata, vreg, shift, nbits, \
	264	ereg0, ebit0, ereg1, ebit1, goreg, gobit) \
64db657b	265	{ \
49610235	266	TPS6586X_REGULATOR(_id, vdata, dvm_ops, vreg, shift, nbits, \
64db657b DH	267	ereg0, ebit0, ereg1, ebit1) \
	268	TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit) \
	269	}
49610235 MR	270
	271	static struct tps6586x_regulator tps6586x_regulator[] = {
	272	TPS6586X_LDO(LDO_0, ldo, SUPPLYV1, 5, 3, ENC, 0, END, 0),
	273	TPS6586X_LDO(LDO_3, ldo, SUPPLYV4, 0, 3, ENC, 2, END, 2),
	274	TPS6586X_LDO(LDO_5, ldo, SUPPLYV6, 0, 3, ENE, 6, ENE, 6),
	275	TPS6586X_LDO(LDO_6, ldo, SUPPLYV3, 0, 3, ENC, 4, END, 4),
	276	TPS6586X_LDO(LDO_7, ldo, SUPPLYV3, 3, 3, ENC, 5, END, 5),
	277	TPS6586X_LDO(LDO_8, ldo, SUPPLYV1, 5, 3, ENC, 6, END, 6),
	278	TPS6586X_LDO(LDO_9, ldo, SUPPLYV6, 3, 3, ENE, 7, ENE, 7),
	279	TPS6586X_LDO(LDO_RTC, ldo, SUPPLYV4, 3, 3, ENE, 7, ENE, 7),
	280	TPS6586X_LDO(LDO_1, dvm, SUPPLYV1, 0, 5, ENC, 1, END, 1),
4cc2e393	281	TPS6586X_LDO(SM_2, sm2, SUPPLYV2, 0, 5, ENC, 1, END, 1),
49610235 MR	282
	283	TPS6586X_DVM(LDO_2, dvm, LDO2BV1, 0, 5, ENA, 3, ENB, 3, VCC2, 6),
	284	TPS6586X_DVM(LDO_4, ldo4, LDO4V1, 0, 5, ENC, 3, END, 3, VCC1, 6),
	285	TPS6586X_DVM(SM_0, dvm, SM0V1, 0, 5, ENA, 1, ENB, 1, VCC1, 2),
	286	TPS6586X_DVM(SM_1, dvm, SM1V1, 0, 5, ENA, 0, ENB, 0, VCC1, 0),
	287	};
	288
	289	/*
	290	* TPS6586X has 2 enable bits that are OR'ed to determine the actual
	291	* regulator state. Clearing one of this bits allows switching
	292	* regulator on and of with single register write.
	293	*/
	294	static inline int tps6586x_regulator_preinit(struct device *parent,
	295	struct tps6586x_regulator *ri)
	296	{
	297	uint8_t val1, val2;
	298	int ret;
	299
	300	ret = tps6586x_read(parent, ri->enable_reg[0], &val1);
	301	if (ret)
	302	return ret;
	303
	304	ret = tps6586x_read(parent, ri->enable_reg[1], &val2);
	305	if (ret)
	306	return ret;
	307
4f586707	308	if (!(val2 & (1 << ri->enable_bit[1])))
49610235 MR	309	return 0;
	310
	311	/*
	312	* The regulator is on, but it's enabled with the bit we don't
	313	* want to use, so we switch the enable bits
	314	*/
4f586707	315	if (!(val1 & (1 << ri->enable_bit[0]))) {
49610235 MR	316	ret = tps6586x_set_bits(parent, ri->enable_reg[0],
	317	1 << ri->enable_bit[0]);
	318	if (ret)
	319	return ret;
	320	}
	321
	322	return tps6586x_clr_bits(parent, ri->enable_reg[1],
	323	1 << ri->enable_bit[1]);
	324	}
	325
	326	static inline struct tps6586x_regulator *find_regulator_info(int id)
	327	{
	328	struct tps6586x_regulator *ri;
	329	int i;
	330
	331	for (i = 0; i < ARRAY_SIZE(tps6586x_regulator); i++) {
	332	ri = &tps6586x_regulator[i];
	333	if (ri->desc.id == id)
	334	return ri;
	335	}
	336	return NULL;
	337	}
	338
	339	static int __devinit tps6586x_regulator_probe(struct platform_device *pdev)
	340	{
	341	struct tps6586x_regulator *ri = NULL;
	342	struct regulator_dev *rdev;
	343	int id = pdev->id;
	344	int err;
	345
	346	dev_dbg(&pdev->dev, "Probing reulator %d\n", id);
	347
	348	ri = find_regulator_info(id);
	349	if (ri == NULL) {
	350	dev_err(&pdev->dev, "invalid regulator ID specified\n");
	351	return -EINVAL;
	352	}
	353
	354	err = tps6586x_regulator_preinit(pdev->dev.parent, ri);
	355	if (err)
	356	return err;
	357
	358	rdev = regulator_register(&ri->desc, &pdev->dev,
	359	pdev->dev.platform_data, ri);
	360	if (IS_ERR(rdev)) {
	361	dev_err(&pdev->dev, "failed to register regulator %s\n",
	362	ri->desc.name);
	363	return PTR_ERR(rdev);
	364	}
	365
e7973c3c	366	platform_set_drvdata(pdev, rdev);
49610235 MR	367
	368	return 0;
	369	}
	370
	371	static int __devexit tps6586x_regulator_remove(struct platform_device *pdev)
	372	{
e7973c3c AL	373	struct regulator_dev *rdev = platform_get_drvdata(pdev);
	374
	375	regulator_unregister(rdev);
49610235 MR	376	return 0;
	377	}
	378
	379	static struct platform_driver tps6586x_regulator_driver = {
	380	.driver = {
	381	.name = "tps6586x-regulator",
	382	.owner = THIS_MODULE,
	383	},
	384	.probe = tps6586x_regulator_probe,
	385	.remove = __devexit_p(tps6586x_regulator_remove),
	386	};
	387
	388	static int __init tps6586x_regulator_init(void)
	389	{
	390	return platform_driver_register(&tps6586x_regulator_driver);
	391	}
	392	subsys_initcall(tps6586x_regulator_init);
	393
	394	static void __exit tps6586x_regulator_exit(void)
	395	{
	396	platform_driver_unregister(&tps6586x_regulator_driver);
	397	}
	398	module_exit(tps6586x_regulator_exit);
	399
	400	MODULE_LICENSE("GPL");
	401	MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
	402	MODULE_DESCRIPTION("Regulator Driver for TI TPS6586X PMIC");
	403	MODULE_ALIAS("platform:tps6586x-regulator");