[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,
				      unsigned *selector)
{
	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) {

			*selector = val;

			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, unsigned *selector)
{
	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,
					  selector);
}

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, unsigned *selector)
{
	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,
					 selector);
	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, SUPPLYV2, 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, V4, 7, V4, 7),
	TPS6586X_LDO(LDO_1, dvm, SUPPLYV1, 0, 5, ENC, 1, END, 1),
	TPS6586X_LDO(SM_2, sm2, SUPPLYV2, 0, 5, ENC, 7, END, 7),

	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;

	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)
{
	struct device *parent = pdev->dev.parent;
	struct regulator_init_data *p = pdev->dev.platform_data;
	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 (pdev->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;
}

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 tps6586x_regulator_set_slew_rate(pdev);
}

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,
3a93f2a9 MB	88	int min_uV, int max_uV,
3a93f2a9 MB	89	unsigned *selector)
49610235 MR	90	{
	91	int val, uV;
	92	uint8_t mask;
	93
	94	for (val = 0; val < ri->desc.n_voltages; val++) {
	95	uV = ri->voltages[val] * 1000;
	96
	97	/* LDO0 has minimal voltage 1.2 rather than 1.25 */
	98	if (ri->desc.id == TPS6586X_ID_LDO_0 && val == 0)
	99	uV -= 50 * 1000;
	100
	101	/* use the first in-range value */
	102	if (min_uV <= uV && uV <= max_uV) {
	103
3a93f2a9 MB	104	*selector = val;
3a93f2a9 MB	105
49610235 MR	106	val <<= ri->volt_shift;
	107	mask = ((1 << ri->volt_nbits) - 1) << ri->volt_shift;
	108
	109	return tps6586x_update(parent, ri->volt_reg, val, mask);
	110	}
	111	}
	112
	113	return -EINVAL;
	114	}
	115
	116	static int tps6586x_ldo_set_voltage(struct regulator_dev *rdev,
3a93f2a9	117	int min_uV, int max_uV, unsigned *selector)
49610235 MR	118	{
	119	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	120	struct device *parent = to_tps6586x_dev(rdev);
	121
3a93f2a9 MB	122	return __tps6586x_ldo_set_voltage(parent, ri, min_uV, max_uV,
3a93f2a9 MB	123	selector);
49610235 MR	124	}
	125
	126	static int tps6586x_ldo_get_voltage(struct regulator_dev *rdev)
	127	{
	128	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	129	struct device *parent = to_tps6586x_dev(rdev);
	130	uint8_t val, mask;
	131	int ret;
	132
	133	ret = tps6586x_read(parent, ri->volt_reg, &val);
	134	if (ret)
	135	return ret;
	136
	137	mask = ((1 << ri->volt_nbits) - 1) << ri->volt_shift;
	138	val = (val & mask) >> ri->volt_shift;
	139
327531ba	140	if (val >= ri->desc.n_voltages)
49610235 MR	141	BUG();
49610235 MR	142
4cc2e393	143	return ri->voltages[val] * 1000;
49610235 MR	144	}
	145
	146	static int tps6586x_dvm_set_voltage(struct regulator_dev *rdev,
3a93f2a9	147	int min_uV, int max_uV, unsigned *selector)
49610235 MR	148	{
	149	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	150	struct device *parent = to_tps6586x_dev(rdev);
	151	int ret;
	152
3a93f2a9 MB	153	ret = __tps6586x_ldo_set_voltage(parent, ri, min_uV, max_uV,
3a93f2a9 MB	154	selector);
49610235 MR	155	if (ret)
	156	return ret;
	157
938b4592	158	return tps6586x_set_bits(parent, ri->go_reg, 1 << ri->go_bit);
49610235 MR	159	}
	160
	161	static int tps6586x_regulator_enable(struct regulator_dev *rdev)
	162	{
	163	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	164	struct device *parent = to_tps6586x_dev(rdev);
	165
	166	return tps6586x_set_bits(parent, ri->enable_reg[0],
	167	1 << ri->enable_bit[0]);
	168	}
	169
	170	static int tps6586x_regulator_disable(struct regulator_dev *rdev)
	171	{
	172	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	173	struct device *parent = to_tps6586x_dev(rdev);
	174
	175	return tps6586x_clr_bits(parent, ri->enable_reg[0],
	176	1 << ri->enable_bit[0]);
	177	}
	178
	179	static int tps6586x_regulator_is_enabled(struct regulator_dev *rdev)
	180	{
	181	struct tps6586x_regulator *ri = rdev_get_drvdata(rdev);
	182	struct device *parent = to_tps6586x_dev(rdev);
	183	uint8_t reg_val;
	184	int ret;
	185
	186	ret = tps6586x_read(parent, ri->enable_reg[0], &reg_val);
	187	if (ret)
	188	return ret;
	189
	190	return !!(reg_val & (1 << ri->enable_bit[0]));
	191	}
	192
	193	static struct regulator_ops tps6586x_regulator_ldo_ops = {
	194	.list_voltage = tps6586x_ldo_list_voltage,
	195	.get_voltage = tps6586x_ldo_get_voltage,
	196	.set_voltage = tps6586x_ldo_set_voltage,
	197
	198	.is_enabled = tps6586x_regulator_is_enabled,
	199	.enable = tps6586x_regulator_enable,
	200	.disable = tps6586x_regulator_disable,
	201	};
	202
	203	static struct regulator_ops tps6586x_regulator_dvm_ops = {
	204	.list_voltage = tps6586x_ldo_list_voltage,
	205	.get_voltage = tps6586x_ldo_get_voltage,
	206	.set_voltage = tps6586x_dvm_set_voltage,
	207
	208	.is_enabled = tps6586x_regulator_is_enabled,
	209	.enable = tps6586x_regulator_enable,
	210	.disable = tps6586x_regulator_disable,
	211	};
	212
	213	static int tps6586x_ldo_voltages[] = {
	214	1250, 1500, 1800, 2500, 2700, 2850, 3100, 3300,
	215	};
	216
	217	static int tps6586x_ldo4_voltages[] = {
	218	1700, 1725, 1750, 1775, 1800, 1825, 1850, 1875,
	219	1900, 1925, 1950, 1975, 2000, 2025, 2050, 2075,
	220	2100, 2125, 2150, 2175, 2200, 2225, 2250, 2275,
	221	2300, 2325, 2350, 2375, 2400, 2425, 2450, 2475,
	222	};
223
4cc2e393 GK	224	static int tps6586x_sm2_voltages[] = {
	225	3000, 3050, 3100, 3150, 3200, 3250, 3300, 3350,
	226	3400, 3450, 3500, 3550, 3600, 3650, 3700, 3750,
	227	3800, 3850, 3900, 3950, 4000, 4050, 4100, 4150,
	228	4200, 4250, 4300, 4350, 4400, 4450, 4500, 4550,
	229	};
	230
49610235 MR	231	static int tps6586x_dvm_voltages[] = {
	232	725, 750, 775, 800, 825, 850, 875, 900,
	233	925, 950, 975, 1000, 1025, 1050, 1075, 1100,
	234	1125, 1150, 1175, 1200, 1225, 1250, 1275, 1300,
	235	1325, 1350, 1375, 1400, 1425, 1450, 1475, 1500,
	236	};
	237
	238	#define TPS6586X_REGULATOR(_id, vdata, _ops, vreg, shift, nbits, \
64db657b	239	ereg0, ebit0, ereg1, ebit1) \
49610235 MR	240	.desc = { \
	241	.name = "REG-" #_id, \
	242	.ops = &tps6586x_regulator_##_ops, \
	243	.type = REGULATOR_VOLTAGE, \
	244	.id = TPS6586X_ID_##_id, \
	245	.n_voltages = ARRAY_SIZE(tps6586x_##vdata##_voltages), \
	246	.owner = THIS_MODULE, \
	247	}, \
	248	.volt_reg = TPS6586X_##vreg, \
	249	.volt_shift = (shift), \
	250	.volt_nbits = (nbits), \
	251	.enable_reg[0] = TPS6586X_SUPPLY##ereg0, \
	252	.enable_bit[0] = (ebit0), \
	253	.enable_reg[1] = TPS6586X_SUPPLY##ereg1, \
	254	.enable_bit[1] = (ebit1), \
64db657b DH	255	.voltages = tps6586x_##vdata##_voltages,
	256
	257	#define TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit) \
	258	.go_reg = TPS6586X_##goreg, \
	259	.go_bit = (gobit),
49610235 MR	260
	261	#define TPS6586X_LDO(_id, vdata, vreg, shift, nbits, \
	262	ereg0, ebit0, ereg1, ebit1) \
64db657b	263	{ \
49610235	264	TPS6586X_REGULATOR(_id, vdata, ldo_ops, vreg, shift, nbits, \
64db657b DH	265	ereg0, ebit0, ereg1, ebit1) \
64db657b DH	266	}
49610235 MR	267
	268	#define TPS6586X_DVM(_id, vdata, vreg, shift, nbits, \
	269	ereg0, ebit0, ereg1, ebit1, goreg, gobit) \
64db657b	270	{ \
49610235	271	TPS6586X_REGULATOR(_id, vdata, dvm_ops, vreg, shift, nbits, \
64db657b DH	272	ereg0, ebit0, ereg1, ebit1) \
	273	TPS6586X_REGULATOR_DVM_GOREG(goreg, gobit) \
	274	}
49610235 MR	275
	276	static struct tps6586x_regulator tps6586x_regulator[] = {
	277	TPS6586X_LDO(LDO_0, ldo, SUPPLYV1, 5, 3, ENC, 0, END, 0),
	278	TPS6586X_LDO(LDO_3, ldo, SUPPLYV4, 0, 3, ENC, 2, END, 2),
	279	TPS6586X_LDO(LDO_5, ldo, SUPPLYV6, 0, 3, ENE, 6, ENE, 6),
	280	TPS6586X_LDO(LDO_6, ldo, SUPPLYV3, 0, 3, ENC, 4, END, 4),
	281	TPS6586X_LDO(LDO_7, ldo, SUPPLYV3, 3, 3, ENC, 5, END, 5),
1b39ed0c	282	TPS6586X_LDO(LDO_8, ldo, SUPPLYV2, 5, 3, ENC, 6, END, 6),
49610235	283	TPS6586X_LDO(LDO_9, ldo, SUPPLYV6, 3, 3, ENE, 7, ENE, 7),
1b39ed0c	284	TPS6586X_LDO(LDO_RTC, ldo, SUPPLYV4, 3, 3, V4, 7, V4, 7),
49610235	285	TPS6586X_LDO(LDO_1, dvm, SUPPLYV1, 0, 5, ENC, 1, END, 1),
1b39ed0c	286	TPS6586X_LDO(SM_2, sm2, SUPPLYV2, 0, 5, ENC, 7, END, 7),
49610235 MR	287
	288	TPS6586X_DVM(LDO_2, dvm, LDO2BV1, 0, 5, ENA, 3, ENB, 3, VCC2, 6),
	289	TPS6586X_DVM(LDO_4, ldo4, LDO4V1, 0, 5, ENC, 3, END, 3, VCC1, 6),
	290	TPS6586X_DVM(SM_0, dvm, SM0V1, 0, 5, ENA, 1, ENB, 1, VCC1, 2),
	291	TPS6586X_DVM(SM_1, dvm, SM1V1, 0, 5, ENA, 0, ENB, 0, VCC1, 0),
	292	};
	293
	294	/*
	295	* TPS6586X has 2 enable bits that are OR'ed to determine the actual
	296	* regulator state. Clearing one of this bits allows switching
	297	* regulator on and of with single register write.
	298	*/
	299	static inline int tps6586x_regulator_preinit(struct device *parent,
	300	struct tps6586x_regulator *ri)
	301	{
	302	uint8_t val1, val2;
	303	int ret;
	304
1dbcf35c DH	305	if (ri->enable_reg[0] == ri->enable_reg[1] &&
	306	ri->enable_bit[0] == ri->enable_bit[1])
	307	return 0;
	308
49610235 MR	309	ret = tps6586x_read(parent, ri->enable_reg[0], &val1);
	310	if (ret)
	311	return ret;
	312
	313	ret = tps6586x_read(parent, ri->enable_reg[1], &val2);
	314	if (ret)
	315	return ret;
	316
4f586707	317	if (!(val2 & (1 << ri->enable_bit[1])))
49610235 MR	318	return 0;
	319
	320	/*
	321	* The regulator is on, but it's enabled with the bit we don't
	322	* want to use, so we switch the enable bits
	323	*/
4f586707	324	if (!(val1 & (1 << ri->enable_bit[0]))) {
49610235 MR	325	ret = tps6586x_set_bits(parent, ri->enable_reg[0],
	326	1 << ri->enable_bit[0]);
	327	if (ret)
	328	return ret;
	329	}
	330
	331	return tps6586x_clr_bits(parent, ri->enable_reg[1],
	332	1 << ri->enable_bit[1]);
	333	}
	334
500c524a XX	335	static int tps6586x_regulator_set_slew_rate(struct platform_device *pdev)
	336	{
	337	struct device *parent = pdev->dev.parent;
	338	struct regulator_init_data *p = pdev->dev.platform_data;
	339	struct tps6586x_settings *setting = p->driver_data;
	340	uint8_t reg;
	341
	342	if (setting == NULL)
	343	return 0;
	344
	345	if (!(setting->slew_rate & TPS6586X_SLEW_RATE_SET))
	346	return 0;
	347
	348	/* only SM0 and SM1 can have the slew rate settings */
	349	switch (pdev->id) {
	350	case TPS6586X_ID_SM_0:
	351	reg = TPS6586X_SM0SL;
	352	break;
	353	case TPS6586X_ID_SM_1:
	354	reg = TPS6586X_SM1SL;
	355	break;
	356	default:
	357	dev_warn(&pdev->dev, "Only SM0/SM1 can set slew rate\n");
	358	return -EINVAL;
	359	}
	360
	361	return tps6586x_write(parent, reg,
	362	setting->slew_rate & TPS6586X_SLEW_RATE_MASK);
	363	}
	364
49610235 MR	365	static inline struct tps6586x_regulator *find_regulator_info(int id)
	366	{
	367	struct tps6586x_regulator *ri;
	368	int i;
	369
	370	for (i = 0; i < ARRAY_SIZE(tps6586x_regulator); i++) {
	371	ri = &tps6586x_regulator[i];
	372	if (ri->desc.id == id)
	373	return ri;
	374	}
	375	return NULL;
	376	}
	377
	378	static int __devinit tps6586x_regulator_probe(struct platform_device *pdev)
	379	{
	380	struct tps6586x_regulator *ri = NULL;
	381	struct regulator_dev *rdev;
	382	int id = pdev->id;
	383	int err;
	384
	385	dev_dbg(&pdev->dev, "Probing reulator %d\n", id);
	386
	387	ri = find_regulator_info(id);
	388	if (ri == NULL) {
	389	dev_err(&pdev->dev, "invalid regulator ID specified\n");
	390	return -EINVAL;
	391	}
	392
	393	err = tps6586x_regulator_preinit(pdev->dev.parent, ri);
	394	if (err)
	395	return err;
	396
	397	rdev = regulator_register(&ri->desc, &pdev->dev,
	398	pdev->dev.platform_data, ri);
	399	if (IS_ERR(rdev)) {
	400	dev_err(&pdev->dev, "failed to register regulator %s\n",
	401	ri->desc.name);
	402	return PTR_ERR(rdev);
	403	}
	404
e7973c3c	405	platform_set_drvdata(pdev, rdev);
49610235	406
500c524a	407	return tps6586x_regulator_set_slew_rate(pdev);
49610235 MR	408	}
	409
	410	static int __devexit tps6586x_regulator_remove(struct platform_device *pdev)
	411	{
e7973c3c AL	412	struct regulator_dev *rdev = platform_get_drvdata(pdev);
	413
	414	regulator_unregister(rdev);
49610235 MR	415	return 0;
	416	}
	417
	418	static struct platform_driver tps6586x_regulator_driver = {
	419	.driver = {
	420	.name = "tps6586x-regulator",
	421	.owner = THIS_MODULE,
	422	},
	423	.probe = tps6586x_regulator_probe,
	424	.remove = __devexit_p(tps6586x_regulator_remove),
	425	};
	426
	427	static int __init tps6586x_regulator_init(void)
	428	{
	429	return platform_driver_register(&tps6586x_regulator_driver);
	430	}
	431	subsys_initcall(tps6586x_regulator_init);
	432
	433	static void __exit tps6586x_regulator_exit(void)
	434	{
	435	platform_driver_unregister(&tps6586x_regulator_driver);
	436	}
	437	module_exit(tps6586x_regulator_exit);
	438
	439	MODULE_LICENSE("GPL");
	440	MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
	441	MODULE_DESCRIPTION("Regulator Driver for TI TPS6586X PMIC");
	442	MODULE_ALIAS("platform:tps6586x-regulator");