[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / regulator / lp3971.c

/*
 * Regulator driver for National Semiconductors LP3971 PMIC chip
 *
 *  Copyright (C) 2009 Samsung Electronics
 *  Author: Marek Szyprowski <m.szyprowski@samsung.com>
 *
 * Based on wm8350.c
 *
 * 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/bug.h>
#include <linux/err.h>
#include <linux/i2c.h>
#include <linux/kernel.h>
#include <linux/regulator/driver.h>
#include <linux/regulator/lp3971.h>

struct lp3971 {
	struct device *dev;
	struct mutex io_lock;
	struct i2c_client *i2c;
	int num_regulators;
	struct regulator_dev **rdev;
};

static u8 lp3971_reg_read(struct lp3971 *lp3971, u8 reg);
static int lp3971_set_bits(struct lp3971 *lp3971, u8 reg, u16 mask, u16 val);

#define LP3971_SYS_CONTROL1_REG 0x07

/* System control register 1 initial value,
   bits 4 and 5 are EPROM programmable */
#define SYS_CONTROL1_INIT_VAL 0x40
#define SYS_CONTROL1_INIT_MASK 0xCF

#define LP3971_BUCK_VOL_ENABLE_REG 0x10
#define LP3971_BUCK_VOL_CHANGE_REG 0x20

/*	Voltage control registers shift:
	LP3971_BUCK1 -> 0
	LP3971_BUCK2 -> 4
	LP3971_BUCK3 -> 6
*/
#define BUCK_VOL_CHANGE_SHIFT(x) (((1 << x) & ~0x01) << 1)
#define BUCK_VOL_CHANGE_FLAG_GO 0x01
#define BUCK_VOL_CHANGE_FLAG_TARGET 0x02
#define BUCK_VOL_CHANGE_FLAG_MASK 0x03

#define LP3971_BUCK1_BASE 0x23
#define LP3971_BUCK2_BASE 0x29
#define LP3971_BUCK3_BASE 0x32

static const int buck_base_addr[] = {
	LP3971_BUCK1_BASE,
	LP3971_BUCK2_BASE,
	LP3971_BUCK3_BASE,
};

#define LP3971_BUCK_TARGET_VOL1_REG(x) (buck_base_addr[x])
#define LP3971_BUCK_TARGET_VOL2_REG(x) (buck_base_addr[x]+1)

static const int buck_voltage_map[] = {
	   0,  800,  850,  900,  950, 1000, 1050, 1100,
	1150, 1200, 1250, 1300, 1350, 1400, 1450, 1500,
	1550, 1600, 1650, 1700, 1800, 1900, 2500, 2800,
	3000, 3300,
};

#define BUCK_TARGET_VOL_MASK 0x3f
#define BUCK_TARGET_VOL_MIN_IDX 0x01
#define BUCK_TARGET_VOL_MAX_IDX 0x19

#define LP3971_BUCK_RAMP_REG(x)	(buck_base_addr[x]+2)

#define LP3971_LDO_ENABLE_REG 0x12
#define LP3971_LDO_VOL_CONTR_BASE 0x39

/*	Voltage control registers:
	LP3971_LDO1 -> LP3971_LDO_VOL_CONTR_BASE + 0
	LP3971_LDO2 -> LP3971_LDO_VOL_CONTR_BASE + 0
	LP3971_LDO3 -> LP3971_LDO_VOL_CONTR_BASE + 1
	LP3971_LDO4 -> LP3971_LDO_VOL_CONTR_BASE + 1
	LP3971_LDO5 -> LP3971_LDO_VOL_CONTR_BASE + 2
*/
#define LP3971_LDO_VOL_CONTR_REG(x)	(LP3971_LDO_VOL_CONTR_BASE + (x >> 1))

/*	Voltage control registers shift:
	LP3971_LDO1 -> 0, LP3971_LDO2 -> 4
	LP3971_LDO3 -> 0, LP3971_LDO4 -> 4
	LP3971_LDO5 -> 0
*/
#define LDO_VOL_CONTR_SHIFT(x) ((x & 1) << 2)
#define LDO_VOL_CONTR_MASK 0x0f

static const int ldo45_voltage_map[] = {
	1000, 1050, 1100, 1150, 1200, 1250, 1300, 1350,
	1400, 1500, 1800, 1900, 2500, 2800, 3000, 3300,
};

static const int ldo123_voltage_map[] = {
	1800, 1900, 2000, 2100, 2200, 2300, 2400, 2500,
	2600, 2700, 2800, 2900, 3000, 3100, 3200, 3300,
};

static const int *ldo_voltage_map[] = {
	ldo123_voltage_map, /* LDO1 */
	ldo123_voltage_map, /* LDO2 */
	ldo123_voltage_map, /* LDO3 */
	ldo45_voltage_map, /* LDO4 */
	ldo45_voltage_map, /* LDO5 */
};

#define LDO_VOL_VALUE_MAP(x) (ldo_voltage_map[(x - LP3971_LDO1)])

#define LDO_VOL_MIN_IDX 0x00
#define LDO_VOL_MAX_IDX 0x0f

static int lp3971_ldo_list_voltage(struct regulator_dev *dev, unsigned index)
{
	int ldo = rdev_get_id(dev) - LP3971_LDO1;
	return 1000 * LDO_VOL_VALUE_MAP(ldo)[index];
}

static int lp3971_ldo_is_enabled(struct regulator_dev *dev)
{
	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	int ldo = rdev_get_id(dev) - LP3971_LDO1;
	u16 mask = 1 << (1 + ldo);
	u16 val;

	val = lp3971_reg_read(lp3971, LP3971_LDO_ENABLE_REG);
	return (val & mask) != 0;
}

static int lp3971_ldo_enable(struct regulator_dev *dev)
{
	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	int ldo = rdev_get_id(dev) - LP3971_LDO1;
	u16 mask = 1 << (1 + ldo);

	return lp3971_set_bits(lp3971, LP3971_LDO_ENABLE_REG, mask, mask);
}

static int lp3971_ldo_disable(struct regulator_dev *dev)
{
	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	int ldo = rdev_get_id(dev) - LP3971_LDO1;
	u16 mask = 1 << (1 + ldo);

	return lp3971_set_bits(lp3971, LP3971_LDO_ENABLE_REG, mask, 0);
}

static int lp3971_ldo_get_voltage(struct regulator_dev *dev)
{
	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	int ldo = rdev_get_id(dev) - LP3971_LDO1;
	u16 val, reg;

	reg = lp3971_reg_read(lp3971, LP3971_LDO_VOL_CONTR_REG(ldo));
	val = (reg >> LDO_VOL_CONTR_SHIFT(ldo)) & LDO_VOL_CONTR_MASK;

	return 1000 * LDO_VOL_VALUE_MAP(ldo)[val];
}

static int lp3971_ldo_set_voltage(struct regulator_dev *dev,
				  int min_uV, int max_uV)
{
	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	int ldo = rdev_get_id(dev) - LP3971_LDO1;
	int min_vol = min_uV / 1000, max_vol = max_uV / 1000;
	const int *vol_map = LDO_VOL_VALUE_MAP(ldo);
	u16 val;

	if (min_vol < vol_map[LDO_VOL_MIN_IDX] ||
	    min_vol > vol_map[LDO_VOL_MAX_IDX])
		return -EINVAL;

	for (val = LDO_VOL_MIN_IDX; val <= LDO_VOL_MAX_IDX; val++)
		if (vol_map[val] >= min_vol)
			break;

	if (val > LDO_VOL_MAX_IDX || vol_map[val] > max_vol)
		return -EINVAL;

	return lp3971_set_bits(lp3971, LP3971_LDO_VOL_CONTR_REG(ldo),
			LDO_VOL_CONTR_MASK << LDO_VOL_CONTR_SHIFT(ldo),
			val << LDO_VOL_CONTR_SHIFT(ldo));
}

static struct regulator_ops lp3971_ldo_ops = {
	.list_voltage = lp3971_ldo_list_voltage,
	.is_enabled = lp3971_ldo_is_enabled,
	.enable = lp3971_ldo_enable,
	.disable = lp3971_ldo_disable,
	.get_voltage = lp3971_ldo_get_voltage,
	.set_voltage = lp3971_ldo_set_voltage,
};

static int lp3971_dcdc_list_voltage(struct regulator_dev *dev, unsigned index)
{
	return 1000 * buck_voltage_map[index];
}

static int lp3971_dcdc_is_enabled(struct regulator_dev *dev)
{
	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	u16 mask = 1 << (buck * 2);
	u16 val;

	val = lp3971_reg_read(lp3971, LP3971_BUCK_VOL_ENABLE_REG);
	return (val & mask) != 0;
}

static int lp3971_dcdc_enable(struct regulator_dev *dev)
{
	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	u16 mask = 1 << (buck * 2);

	return lp3971_set_bits(lp3971, LP3971_BUCK_VOL_ENABLE_REG, mask, mask);
}

static int lp3971_dcdc_disable(struct regulator_dev *dev)
{
	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	u16 mask = 1 << (buck * 2);

	return lp3971_set_bits(lp3971, LP3971_BUCK_VOL_ENABLE_REG, mask, 0);
}

static int lp3971_dcdc_get_voltage(struct regulator_dev *dev)
{
	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	u16 reg;
	int val;

	reg = lp3971_reg_read(lp3971, LP3971_BUCK_TARGET_VOL1_REG(buck));
	reg &= BUCK_TARGET_VOL_MASK;

	if (reg <= BUCK_TARGET_VOL_MAX_IDX)
		val = 1000 * buck_voltage_map[reg];
	else {
		val = 0;
		dev_warn(&dev->dev, "chip reported incorrect voltage value.\n");
	}

	return val;
}

static int lp3971_dcdc_set_voltage(struct regulator_dev *dev,
				  int min_uV, int max_uV)
{
	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	int min_vol = min_uV / 1000, max_vol = max_uV / 1000;
	const int *vol_map = buck_voltage_map;
	u16 val;
	int ret;

	if (min_vol < vol_map[BUCK_TARGET_VOL_MIN_IDX] ||
	    min_vol > vol_map[BUCK_TARGET_VOL_MAX_IDX])
		return -EINVAL;

	for (val = BUCK_TARGET_VOL_MIN_IDX; val <= BUCK_TARGET_VOL_MAX_IDX;
	     val++)
		if (vol_map[val] >= min_vol)
			break;

	if (val > BUCK_TARGET_VOL_MAX_IDX || vol_map[val] > max_vol)
		return -EINVAL;

	ret = lp3971_set_bits(lp3971, LP3971_BUCK_TARGET_VOL1_REG(buck),
	       BUCK_TARGET_VOL_MASK, val);
	if (ret)
		return ret;

	ret = lp3971_set_bits(lp3971, LP3971_BUCK_VOL_CHANGE_REG,
	       BUCK_VOL_CHANGE_FLAG_MASK << BUCK_VOL_CHANGE_SHIFT(buck),
	       BUCK_VOL_CHANGE_FLAG_GO << BUCK_VOL_CHANGE_SHIFT(buck));
	if (ret)
		return ret;

	return lp3971_set_bits(lp3971, LP3971_BUCK_VOL_CHANGE_REG,
	       BUCK_VOL_CHANGE_FLAG_MASK << BUCK_VOL_CHANGE_SHIFT(buck),
	       0 << BUCK_VOL_CHANGE_SHIFT(buck));
}

static struct regulator_ops lp3971_dcdc_ops = {
	.list_voltage = lp3971_dcdc_list_voltage,
	.is_enabled = lp3971_dcdc_is_enabled,
	.enable = lp3971_dcdc_enable,
	.disable = lp3971_dcdc_disable,
	.get_voltage = lp3971_dcdc_get_voltage,
	.set_voltage = lp3971_dcdc_set_voltage,
};

static struct regulator_desc regulators[] = {
	{
		.name = "LDO1",
		.id = LP3971_LDO1,
		.ops = &lp3971_ldo_ops,
		.n_voltages = ARRAY_SIZE(ldo123_voltage_map),
		.type = REGULATOR_VOLTAGE,
		.owner = THIS_MODULE,
	},
	{
		.name = "LDO2",
		.id = LP3971_LDO2,
		.ops = &lp3971_ldo_ops,
		.n_voltages = ARRAY_SIZE(ldo123_voltage_map),
		.type = REGULATOR_VOLTAGE,
		.owner = THIS_MODULE,
	},
	{
		.name = "LDO3",
		.id = LP3971_LDO3,
		.ops = &lp3971_ldo_ops,
		.n_voltages = ARRAY_SIZE(ldo123_voltage_map),
		.type = REGULATOR_VOLTAGE,
		.owner = THIS_MODULE,
	},
	{
		.name = "LDO4",
		.id = LP3971_LDO4,
		.ops = &lp3971_ldo_ops,
		.n_voltages = ARRAY_SIZE(ldo45_voltage_map),
		.type = REGULATOR_VOLTAGE,
		.owner = THIS_MODULE,
	},
	{
		.name = "LDO5",
		.id = LP3971_LDO5,
		.ops = &lp3971_ldo_ops,
		.n_voltages = ARRAY_SIZE(ldo45_voltage_map),
		.type = REGULATOR_VOLTAGE,
		.owner = THIS_MODULE,
	},
	{
		.name = "DCDC1",
		.id = LP3971_DCDC1,
		.ops = &lp3971_dcdc_ops,
		.n_voltages = ARRAY_SIZE(buck_voltage_map),
		.type = REGULATOR_VOLTAGE,
		.owner = THIS_MODULE,
	},
	{
		.name = "DCDC2",
		.id = LP3971_DCDC2,
		.ops = &lp3971_dcdc_ops,
		.n_voltages = ARRAY_SIZE(buck_voltage_map),
		.type = REGULATOR_VOLTAGE,
		.owner = THIS_MODULE,
	},
	{
		.name = "DCDC3",
		.id = LP3971_DCDC3,
		.ops = &lp3971_dcdc_ops,
		.n_voltages = ARRAY_SIZE(buck_voltage_map),
		.type = REGULATOR_VOLTAGE,
		.owner = THIS_MODULE,
	},
};

static int lp3971_i2c_read(struct i2c_client *i2c, char reg, int count,
	u16 *dest)
{
	int ret;

	if (count != 1)
		return -EIO;
	ret = i2c_smbus_read_byte_data(i2c, reg);
	if (ret < 0 || count != 1)
		return -EIO;

	*dest = ret;
	return 0;
}

static int lp3971_i2c_write(struct i2c_client *i2c, char reg, int count,
	const u16 *src)
{
	int ret;

	if (count != 1)
		return -EIO;
	ret = i2c_smbus_write_byte_data(i2c, reg, *src);
	if (ret >= 0)
		return 0;

	return ret;
}

static u8 lp3971_reg_read(struct lp3971 *lp3971, u8 reg)
{
	u16 val = 0;

	mutex_lock(&lp3971->io_lock);

	lp3971_i2c_read(lp3971->i2c, reg, 1, &val);

	dev_dbg(lp3971->dev, "reg read 0x%02x -> 0x%02x\n", (int)reg,
		(unsigned)val&0xff);

	mutex_unlock(&lp3971->io_lock);

	return val & 0xff;
}

static int lp3971_set_bits(struct lp3971 *lp3971, u8 reg, u16 mask, u16 val)
{
	u16 tmp;
	int ret;

	mutex_lock(&lp3971->io_lock);

	ret = lp3971_i2c_read(lp3971->i2c, reg, 1, &tmp);
	tmp = (tmp & ~mask) | val;
	if (ret == 0) {
		ret = lp3971_i2c_write(lp3971->i2c, reg, 1, &tmp);
		dev_dbg(lp3971->dev, "reg write 0x%02x -> 0x%02x\n", (int)reg,
			(unsigned)val&0xff);
	}
	mutex_unlock(&lp3971->io_lock);

	return ret;
}

static int __devinit setup_regulators(struct lp3971 *lp3971,
				      struct lp3971_platform_data *pdata)
{
	int i, err;

	lp3971->num_regulators = pdata->num_regulators;
	lp3971->rdev = kcalloc(pdata->num_regulators,
				sizeof(struct regulator_dev *), GFP_KERNEL);
	if (!lp3971->rdev) {
		err = -ENOMEM;
		goto err_nomem;
	}

	/* Instantiate the regulators */
	for (i = 0; i < pdata->num_regulators; i++) {
		struct lp3971_regulator_subdev *reg = &pdata->regulators[i];
		lp3971->rdev[i] = regulator_register(&regulators[reg->id],
					lp3971->dev, reg->initdata, lp3971);

		if (IS_ERR(lp3971->rdev[i])) {
			err = PTR_ERR(lp3971->rdev[i]);
			dev_err(lp3971->dev, "regulator init failed: %d\n",
				err);
			goto error;
		}
	}

	return 0;

error:
	while (--i >= 0)
		regulator_unregister(lp3971->rdev[i]);
	kfree(lp3971->rdev);
	lp3971->rdev = NULL;
err_nomem:
	return err;
}

static int __devinit lp3971_i2c_probe(struct i2c_client *i2c,
			    const struct i2c_device_id *id)
{
	struct lp3971 *lp3971;
	struct lp3971_platform_data *pdata = i2c->dev.platform_data;
	int ret;
	u16 val;

	if (!pdata) {
		dev_dbg(&i2c->dev, "No platform init data supplied\n");
		return -ENODEV;
	}

	lp3971 = kzalloc(sizeof(struct lp3971), GFP_KERNEL);
	if (lp3971 == NULL)
		return -ENOMEM;

	lp3971->i2c = i2c;
	lp3971->dev = &i2c->dev;

	mutex_init(&lp3971->io_lock);

	/* Detect LP3971 */
	ret = lp3971_i2c_read(i2c, LP3971_SYS_CONTROL1_REG, 1, &val);
	if (ret == 0 && (val & SYS_CONTROL1_INIT_MASK) != SYS_CONTROL1_INIT_VAL)
		ret = -ENODEV;
	if (ret < 0) {
		dev_err(&i2c->dev, "failed to detect device\n");
		goto err_detect;
	}

	ret = setup_regulators(lp3971, pdata);
	if (ret < 0)
		goto err_detect;

	i2c_set_clientdata(i2c, lp3971);
	return 0;

err_detect:
	kfree(lp3971);
	return ret;
}

static int __devexit lp3971_i2c_remove(struct i2c_client *i2c)
{
	struct lp3971 *lp3971 = i2c_get_clientdata(i2c);
	int i;

	i2c_set_clientdata(i2c, NULL);

	for (i = 0; i < lp3971->num_regulators; i++)
		regulator_unregister(lp3971->rdev[i]);

	kfree(lp3971->rdev);
	kfree(lp3971);

	return 0;
}

static const struct i2c_device_id lp3971_i2c_id[] = {
       { "lp3971", 0 },
       { }
};
MODULE_DEVICE_TABLE(i2c, lp3971_i2c_id);

static struct i2c_driver lp3971_i2c_driver = {
	.driver = {
		.name = "LP3971",
		.owner = THIS_MODULE,
	},
	.probe    = lp3971_i2c_probe,
	.remove   = __devexit_p(lp3971_i2c_remove),
	.id_table = lp3971_i2c_id,
};

static int __init lp3971_module_init(void)
{
	int ret;

	ret = i2c_add_driver(&lp3971_i2c_driver);
	if (ret != 0)
		pr_err("Failed to register I2C driver: %d\n", ret);

	return ret;
}
module_init(lp3971_module_init);

static void __exit lp3971_module_exit(void)
{
	i2c_del_driver(&lp3971_i2c_driver);
}
module_exit(lp3971_module_exit);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Marek Szyprowski <m.szyprowski@samsung.com>");
MODULE_DESCRIPTION("LP3971 PMIC driver");
Commit	Line	Data
0cbdf7bc MS	1	/*
	2	* Regulator driver for National Semiconductors LP3971 PMIC chip
	3	*
	4	* Copyright (C) 2009 Samsung Electronics
	5	* Author: Marek Szyprowski <m.szyprowski@samsung.com>
	6	*
	7	* Based on wm8350.c
	8	*
	9	* This program is free software; you can redistribute it and/or modify
	10	* it under the terms of the GNU General Public License version 2 as
	11	* published by the Free Software Foundation.
	12	*
	13	*/
	14
	15	#include <linux/bug.h>
	16	#include <linux/err.h>
	17	#include <linux/i2c.h>
	18	#include <linux/kernel.h>
	19	#include <linux/regulator/driver.h>
	20	#include <linux/regulator/lp3971.h>
	21
	22	struct lp3971 {
	23	struct device *dev;
	24	struct mutex io_lock;
	25	struct i2c_client *i2c;
	26	int num_regulators;
	27	struct regulator_dev **rdev;
	28	};
	29
	30	static u8 lp3971_reg_read(struct lp3971 *lp3971, u8 reg);
	31	static int lp3971_set_bits(struct lp3971 *lp3971, u8 reg, u16 mask, u16 val);
	32
	33	#define LP3971_SYS_CONTROL1_REG 0x07
	34
	35	/* System control register 1 initial value,
	36	bits 4 and 5 are EPROM programmable */
	37	#define SYS_CONTROL1_INIT_VAL 0x40
	38	#define SYS_CONTROL1_INIT_MASK 0xCF
	39
	40	#define LP3971_BUCK_VOL_ENABLE_REG 0x10
	41	#define LP3971_BUCK_VOL_CHANGE_REG 0x20
	42
	43	/* Voltage control registers shift:
	44	LP3971_BUCK1 -> 0
	45	LP3971_BUCK2 -> 4
	46	LP3971_BUCK3 -> 6
	47	*/
	48	#define BUCK_VOL_CHANGE_SHIFT(x) (((1 << x) & ~0x01) << 1)
	49	#define BUCK_VOL_CHANGE_FLAG_GO 0x01
	50	#define BUCK_VOL_CHANGE_FLAG_TARGET 0x02
	51	#define BUCK_VOL_CHANGE_FLAG_MASK 0x03
	52
	53	#define LP3971_BUCK1_BASE 0x23
	54	#define LP3971_BUCK2_BASE 0x29
	55	#define LP3971_BUCK3_BASE 0x32
	56
6faa7e0a	57	static const int buck_base_addr[] = {
0cbdf7bc MS	58	LP3971_BUCK1_BASE,
	59	LP3971_BUCK2_BASE,
	60	LP3971_BUCK3_BASE,
	61	};
	62
	63	#define LP3971_BUCK_TARGET_VOL1_REG(x) (buck_base_addr[x])
	64	#define LP3971_BUCK_TARGET_VOL2_REG(x) (buck_base_addr[x]+1)
	65
6faa7e0a	66	static const int buck_voltage_map[] = {
0cbdf7bc MS	67	0, 800, 850, 900, 950, 1000, 1050, 1100,
	68	1150, 1200, 1250, 1300, 1350, 1400, 1450, 1500,
	69	1550, 1600, 1650, 1700, 1800, 1900, 2500, 2800,
	70	3000, 3300,
	71	};
	72
	73	#define BUCK_TARGET_VOL_MASK 0x3f
	74	#define BUCK_TARGET_VOL_MIN_IDX 0x01
	75	#define BUCK_TARGET_VOL_MAX_IDX 0x19
	76
	77	#define LP3971_BUCK_RAMP_REG(x) (buck_base_addr[x]+2)
	78
	79	#define LP3971_LDO_ENABLE_REG 0x12
	80	#define LP3971_LDO_VOL_CONTR_BASE 0x39
	81
	82	/* Voltage control registers:
	83	LP3971_LDO1 -> LP3971_LDO_VOL_CONTR_BASE + 0
	84	LP3971_LDO2 -> LP3971_LDO_VOL_CONTR_BASE + 0
	85	LP3971_LDO3 -> LP3971_LDO_VOL_CONTR_BASE + 1
	86	LP3971_LDO4 -> LP3971_LDO_VOL_CONTR_BASE + 1
	87	LP3971_LDO5 -> LP3971_LDO_VOL_CONTR_BASE + 2
	88	*/
	89	#define LP3971_LDO_VOL_CONTR_REG(x) (LP3971_LDO_VOL_CONTR_BASE + (x >> 1))
	90
	91	/* Voltage control registers shift:
	92	LP3971_LDO1 -> 0, LP3971_LDO2 -> 4
	93	LP3971_LDO3 -> 0, LP3971_LDO4 -> 4
	94	LP3971_LDO5 -> 0
	95	*/
	96	#define LDO_VOL_CONTR_SHIFT(x) ((x & 1) << 2)
	97	#define LDO_VOL_CONTR_MASK 0x0f
	98
6faa7e0a	99	static const int ldo45_voltage_map[] = {
0cbdf7bc MS	100	1000, 1050, 1100, 1150, 1200, 1250, 1300, 1350,
	101	1400, 1500, 1800, 1900, 2500, 2800, 3000, 3300,
	102	};
	103
6faa7e0a	104	static const int ldo123_voltage_map[] = {
0cbdf7bc MS	105	1800, 1900, 2000, 2100, 2200, 2300, 2400, 2500,
	106	2600, 2700, 2800, 2900, 3000, 3100, 3200, 3300,
	107	};
	108
6faa7e0a	109	static const int *ldo_voltage_map[] = {
0cbdf7bc MS	110	ldo123_voltage_map, /* LDO1 */
	111	ldo123_voltage_map, /* LDO2 */
	112	ldo123_voltage_map, /* LDO3 */
	113	ldo45_voltage_map, /* LDO4 */
	114	ldo45_voltage_map, /* LDO5 */
	115	};
	116
	117	#define LDO_VOL_VALUE_MAP(x) (ldo_voltage_map[(x - LP3971_LDO1)])
	118
	119	#define LDO_VOL_MIN_IDX 0x00
	120	#define LDO_VOL_MAX_IDX 0x0f
	121
	122	static int lp3971_ldo_list_voltage(struct regulator_dev *dev, unsigned index)
	123	{
	124	int ldo = rdev_get_id(dev) - LP3971_LDO1;
	125	return 1000 * LDO_VOL_VALUE_MAP(ldo)[index];
	126	}
	127
	128	static int lp3971_ldo_is_enabled(struct regulator_dev *dev)
	129	{
	130	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	131	int ldo = rdev_get_id(dev) - LP3971_LDO1;
	132	u16 mask = 1 << (1 + ldo);
	133	u16 val;
	134
	135	val = lp3971_reg_read(lp3971, LP3971_LDO_ENABLE_REG);
	136	return (val & mask) != 0;
	137	}
	138
	139	static int lp3971_ldo_enable(struct regulator_dev *dev)
	140	{
	141	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	142	int ldo = rdev_get_id(dev) - LP3971_LDO1;
	143	u16 mask = 1 << (1 + ldo);
	144
	145	return lp3971_set_bits(lp3971, LP3971_LDO_ENABLE_REG, mask, mask);
	146	}
	147
	148	static int lp3971_ldo_disable(struct regulator_dev *dev)
	149	{
	150	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	151	int ldo = rdev_get_id(dev) - LP3971_LDO1;
	152	u16 mask = 1 << (1 + ldo);
	153
	154	return lp3971_set_bits(lp3971, LP3971_LDO_ENABLE_REG, mask, 0);
	155	}
	156
	157	static int lp3971_ldo_get_voltage(struct regulator_dev *dev)
	158	{
	159	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	160	int ldo = rdev_get_id(dev) - LP3971_LDO1;
	161	u16 val, reg;
	162
	163	reg = lp3971_reg_read(lp3971, LP3971_LDO_VOL_CONTR_REG(ldo));
	164	val = (reg >> LDO_VOL_CONTR_SHIFT(ldo)) & LDO_VOL_CONTR_MASK;
	165
	166	return 1000 * LDO_VOL_VALUE_MAP(ldo)[val];
	167	}
	168
	169	static int lp3971_ldo_set_voltage(struct regulator_dev *dev,
	170	int min_uV, int max_uV)
	171	{
	172	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	173	int ldo = rdev_get_id(dev) - LP3971_LDO1;
174	int min_vol = min_uV / 1000, max_vol = max_uV / 1000;
175	const int *vol_map = LDO_VOL_VALUE_MAP(ldo);
176	u16 val;
177
178	if (min_vol < vol_map[LDO_VOL_MIN_IDX] \|\|
179	min_vol > vol_map[LDO_VOL_MAX_IDX])
180	return -EINVAL;
181
182	for (val = LDO_VOL_MIN_IDX; val <= LDO_VOL_MAX_IDX; val++)
183	if (vol_map[val] >= min_vol)
184	break;
185
62737d44	186	if (val > LDO_VOL_MAX_IDX \|\| vol_map[val] > max_vol)
0cbdf7bc MS	187	return -EINVAL;
	188
	189	return lp3971_set_bits(lp3971, LP3971_LDO_VOL_CONTR_REG(ldo),
cdb868f5 AL	190	LDO_VOL_CONTR_MASK << LDO_VOL_CONTR_SHIFT(ldo),
cdb868f5 AL	191	val << LDO_VOL_CONTR_SHIFT(ldo));
0cbdf7bc MS	192	}
	193
	194	static struct regulator_ops lp3971_ldo_ops = {
	195	.list_voltage = lp3971_ldo_list_voltage,
	196	.is_enabled = lp3971_ldo_is_enabled,
	197	.enable = lp3971_ldo_enable,
	198	.disable = lp3971_ldo_disable,
	199	.get_voltage = lp3971_ldo_get_voltage,
	200	.set_voltage = lp3971_ldo_set_voltage,
	201	};
	202
	203	static int lp3971_dcdc_list_voltage(struct regulator_dev *dev, unsigned index)
	204	{
	205	return 1000 * buck_voltage_map[index];
	206	}
	207
	208	static int lp3971_dcdc_is_enabled(struct regulator_dev *dev)
	209	{
	210	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	211	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	212	u16 mask = 1 << (buck * 2);
	213	u16 val;
	214
	215	val = lp3971_reg_read(lp3971, LP3971_BUCK_VOL_ENABLE_REG);
	216	return (val & mask) != 0;
	217	}
	218
	219	static int lp3971_dcdc_enable(struct regulator_dev *dev)
	220	{
	221	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	222	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	223	u16 mask = 1 << (buck * 2);
	224
	225	return lp3971_set_bits(lp3971, LP3971_BUCK_VOL_ENABLE_REG, mask, mask);
	226	}
	227
	228	static int lp3971_dcdc_disable(struct regulator_dev *dev)
	229	{
	230	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	231	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	232	u16 mask = 1 << (buck * 2);
	233
	234	return lp3971_set_bits(lp3971, LP3971_BUCK_VOL_ENABLE_REG, mask, 0);
	235	}
	236
	237	static int lp3971_dcdc_get_voltage(struct regulator_dev *dev)
	238	{
	239	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	240	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	241	u16 reg;
	242	int val;
	243
	244	reg = lp3971_reg_read(lp3971, LP3971_BUCK_TARGET_VOL1_REG(buck));
	245	reg &= BUCK_TARGET_VOL_MASK;
	246
	247	if (reg <= BUCK_TARGET_VOL_MAX_IDX)
	248	val = 1000 * buck_voltage_map[reg];
	249	else {
	250	val = 0;
	251	dev_warn(&dev->dev, "chip reported incorrect voltage value.\n");
	252	}
	253
	254	return val;
	255	}
256
257	static int lp3971_dcdc_set_voltage(struct regulator_dev *dev,
258	int min_uV, int max_uV)
259	{
260	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
261	int buck = rdev_get_id(dev) - LP3971_DCDC1;
262	int min_vol = min_uV / 1000, max_vol = max_uV / 1000;
263	const int *vol_map = buck_voltage_map;
264	u16 val;
265	int ret;
266
267	if (min_vol < vol_map[BUCK_TARGET_VOL_MIN_IDX] \|\|
268	min_vol > vol_map[BUCK_TARGET_VOL_MAX_IDX])
269	return -EINVAL;
270
271	for (val = BUCK_TARGET_VOL_MIN_IDX; val <= BUCK_TARGET_VOL_MAX_IDX;
272	val++)
273	if (vol_map[val] >= min_vol)
274	break;
275
62737d44	276	if (val > BUCK_TARGET_VOL_MAX_IDX \|\| vol_map[val] > max_vol)
0cbdf7bc MS	277	return -EINVAL;
	278
	279	ret = lp3971_set_bits(lp3971, LP3971_BUCK_TARGET_VOL1_REG(buck),
	280	BUCK_TARGET_VOL_MASK, val);
	281	if (ret)
	282	return ret;
	283
	284	ret = lp3971_set_bits(lp3971, LP3971_BUCK_VOL_CHANGE_REG,
	285	BUCK_VOL_CHANGE_FLAG_MASK << BUCK_VOL_CHANGE_SHIFT(buck),
	286	BUCK_VOL_CHANGE_FLAG_GO << BUCK_VOL_CHANGE_SHIFT(buck));
	287	if (ret)
	288	return ret;
	289
	290	return lp3971_set_bits(lp3971, LP3971_BUCK_VOL_CHANGE_REG,
	291	BUCK_VOL_CHANGE_FLAG_MASK << BUCK_VOL_CHANGE_SHIFT(buck),
	292	0 << BUCK_VOL_CHANGE_SHIFT(buck));
	293	}
	294
	295	static struct regulator_ops lp3971_dcdc_ops = {
	296	.list_voltage = lp3971_dcdc_list_voltage,
	297	.is_enabled = lp3971_dcdc_is_enabled,
	298	.enable = lp3971_dcdc_enable,
	299	.disable = lp3971_dcdc_disable,
	300	.get_voltage = lp3971_dcdc_get_voltage,
	301	.set_voltage = lp3971_dcdc_set_voltage,
	302	};
	303
	304	static struct regulator_desc regulators[] = {
	305	{
	306	.name = "LDO1",
	307	.id = LP3971_LDO1,
	308	.ops = &lp3971_ldo_ops,
	309	.n_voltages = ARRAY_SIZE(ldo123_voltage_map),
	310	.type = REGULATOR_VOLTAGE,
	311	.owner = THIS_MODULE,
	312	},
	313	{
	314	.name = "LDO2",
	315	.id = LP3971_LDO2,
	316	.ops = &lp3971_ldo_ops,
	317	.n_voltages = ARRAY_SIZE(ldo123_voltage_map),
	318	.type = REGULATOR_VOLTAGE,
	319	.owner = THIS_MODULE,
	320	},
	321	{
	322	.name = "LDO3",
	323	.id = LP3971_LDO3,
	324	.ops = &lp3971_ldo_ops,
	325	.n_voltages = ARRAY_SIZE(ldo123_voltage_map),
	326	.type = REGULATOR_VOLTAGE,
	327	.owner = THIS_MODULE,
	328	},
	329	{
	330	.name = "LDO4",
	331	.id = LP3971_LDO4,
	332	.ops = &lp3971_ldo_ops,
	333	.n_voltages = ARRAY_SIZE(ldo45_voltage_map),
	334	.type = REGULATOR_VOLTAGE,
	335	.owner = THIS_MODULE,
	336	},
	337	{
	338	.name = "LDO5",
	339	.id = LP3971_LDO5,
	340	.ops = &lp3971_ldo_ops,
341	.n_voltages = ARRAY_SIZE(ldo45_voltage_map),
342	.type = REGULATOR_VOLTAGE,
343	.owner = THIS_MODULE,
344	},
345	{
346	.name = "DCDC1",
347	.id = LP3971_DCDC1,
348	.ops = &lp3971_dcdc_ops,
349	.n_voltages = ARRAY_SIZE(buck_voltage_map),
350	.type = REGULATOR_VOLTAGE,
351	.owner = THIS_MODULE,
352	},
353	{
354	.name = "DCDC2",
355	.id = LP3971_DCDC2,
356	.ops = &lp3971_dcdc_ops,
357	.n_voltages = ARRAY_SIZE(buck_voltage_map),
358	.type = REGULATOR_VOLTAGE,
359	.owner = THIS_MODULE,
360	},
361	{
362	.name = "DCDC3",
363	.id = LP3971_DCDC3,
364	.ops = &lp3971_dcdc_ops,
365	.n_voltages = ARRAY_SIZE(buck_voltage_map),
366	.type = REGULATOR_VOLTAGE,
367	.owner = THIS_MODULE,
368	},
369	};
370
371	static int lp3971_i2c_read(struct i2c_client *i2c, char reg, int count,
372	u16 *dest)
373	{
374	int ret;
375
376	if (count != 1)
377	return -EIO;
378	ret = i2c_smbus_read_byte_data(i2c, reg);
379	if (ret < 0 \|\| count != 1)
380	return -EIO;
381
382	*dest = ret;
383	return 0;
384	}
385
386	static int lp3971_i2c_write(struct i2c_client *i2c, char reg, int count,
387	const u16 *src)
388	{
389	int ret;
390
391	if (count != 1)
392	return -EIO;
393	ret = i2c_smbus_write_byte_data(i2c, reg, *src);
394	if (ret >= 0)
395	return 0;
396
397	return ret;
398	}
399
400	static u8 lp3971_reg_read(struct lp3971 *lp3971, u8 reg)
401	{
402	u16 val = 0;
403
404	mutex_lock(&lp3971->io_lock);
405
406	lp3971_i2c_read(lp3971->i2c, reg, 1, &val);
407
408	dev_dbg(lp3971->dev, "reg read 0x%02x -> 0x%02x\n", (int)reg,
409	(unsigned)val&0xff);
410
411	mutex_unlock(&lp3971->io_lock);
412
413	return val & 0xff;
414	}
415
416	static int lp3971_set_bits(struct lp3971 *lp3971, u8 reg, u16 mask, u16 val)
417	{
418	u16 tmp;
419	int ret;
420
421	mutex_lock(&lp3971->io_lock);
422
423	ret = lp3971_i2c_read(lp3971->i2c, reg, 1, &tmp);
424	tmp = (tmp & ~mask) \| val;
425	if (ret == 0) {
426	ret = lp3971_i2c_write(lp3971->i2c, reg, 1, &tmp);
427	dev_dbg(lp3971->dev, "reg write 0x%02x -> 0x%02x\n", (int)reg,
428	(unsigned)val&0xff);
429	}
430	mutex_unlock(&lp3971->io_lock);
431
432	return ret;
433	}
434
ebbed04f DT	435	static int __devinit setup_regulators(struct lp3971 *lp3971,
ebbed04f DT	436	struct lp3971_platform_data *pdata)
0cbdf7bc MS	437	{
0cbdf7bc MS	438	int i, err;
ebbed04f DT	439
	440	lp3971->num_regulators = pdata->num_regulators;
	441	lp3971->rdev = kcalloc(pdata->num_regulators,
	442	sizeof(struct regulator_dev *), GFP_KERNEL);
67e46f34 DC	443	if (!lp3971->rdev) {
	444	err = -ENOMEM;
	445	goto err_nomem;
	446	}
0cbdf7bc MS	447
0cbdf7bc MS	448	/* Instantiate the regulators */
ebbed04f DT	449	for (i = 0; i < pdata->num_regulators; i++) {
	450	struct lp3971_regulator_subdev *reg = &pdata->regulators[i];
	451	lp3971->rdev[i] = regulator_register(&regulators[reg->id],
	452	lp3971->dev, reg->initdata, lp3971);
0cbdf7bc	453
d662fc82 JL	454	if (IS_ERR(lp3971->rdev[i])) {
d662fc82 JL	455	err = PTR_ERR(lp3971->rdev[i]);
0cbdf7bc MS	456	dev_err(lp3971->dev, "regulator init failed: %d\n",
	457	err);
	458	goto error;
	459	}
	460	}
	461
	462	return 0;
ebbed04f	463
0cbdf7bc	464	error:
ebbed04f DT	465	while (--i >= 0)
ebbed04f DT	466	regulator_unregister(lp3971->rdev[i]);
0cbdf7bc MS	467	kfree(lp3971->rdev);
0cbdf7bc MS	468	lp3971->rdev = NULL;
67e46f34	469	err_nomem:
0cbdf7bc MS	470	return err;
	471	}
	472
	473	static int __devinit lp3971_i2c_probe(struct i2c_client *i2c,
	474	const struct i2c_device_id *id)
	475	{
	476	struct lp3971 *lp3971;
	477	struct lp3971_platform_data *pdata = i2c->dev.platform_data;
	478	int ret;
	479	u16 val;
	480
ebbed04f DT	481	if (!pdata) {
	482	dev_dbg(&i2c->dev, "No platform init data supplied\n");
	483	return -ENODEV;
0cbdf7bc MS	484	}
0cbdf7bc MS	485
ebbed04f DT	486	lp3971 = kzalloc(sizeof(struct lp3971), GFP_KERNEL);
	487	if (lp3971 == NULL)
	488	return -ENOMEM;
	489
0cbdf7bc MS	490	lp3971->i2c = i2c;
0cbdf7bc MS	491	lp3971->dev = &i2c->dev;
0cbdf7bc MS	492
	493	mutex_init(&lp3971->io_lock);
	494
	495	/* Detect LP3971 */
	496	ret = lp3971_i2c_read(i2c, LP3971_SYS_CONTROL1_REG, 1, &val);
	497	if (ret == 0 && (val & SYS_CONTROL1_INIT_MASK) != SYS_CONTROL1_INIT_VAL)
	498	ret = -ENODEV;
	499	if (ret < 0) {
	500	dev_err(&i2c->dev, "failed to detect device\n");
	501	goto err_detect;
	502	}
	503
ebbed04f DT	504	ret = setup_regulators(lp3971, pdata);
	505	if (ret < 0)
	506	goto err_detect;
0cbdf7bc	507
ebbed04f	508	i2c_set_clientdata(i2c, lp3971);
0cbdf7bc MS	509	return 0;
	510
	511	err_detect:
0cbdf7bc	512	kfree(lp3971);
0cbdf7bc MS	513	return ret;
	514	}
	515
	516	static int __devexit lp3971_i2c_remove(struct i2c_client *i2c)
	517	{
	518	struct lp3971 *lp3971 = i2c_get_clientdata(i2c);
	519	int i;
ebbed04f DT	520
	521	i2c_set_clientdata(i2c, NULL);
	522
0cbdf7bc	523	for (i = 0; i < lp3971->num_regulators; i++)
ebbed04f DT	524	regulator_unregister(lp3971->rdev[i]);
ebbed04f DT	525
0cbdf7bc	526	kfree(lp3971->rdev);
0cbdf7bc MS	527	kfree(lp3971);
	528
	529	return 0;
	530	}
	531
	532	static const struct i2c_device_id lp3971_i2c_id[] = {
	533	{ "lp3971", 0 },
	534	{ }
	535	};
	536	MODULE_DEVICE_TABLE(i2c, lp3971_i2c_id);
	537
	538	static struct i2c_driver lp3971_i2c_driver = {
	539	.driver = {
	540	.name = "LP3971",
	541	.owner = THIS_MODULE,
	542	},
	543	.probe = lp3971_i2c_probe,
6113c3a5	544	.remove = __devexit_p(lp3971_i2c_remove),
0cbdf7bc MS	545	.id_table = lp3971_i2c_id,
	546	};
	547
	548	static int __init lp3971_module_init(void)
	549	{
12a1d933	550	int ret;
0cbdf7bc MS	551
	552	ret = i2c_add_driver(&lp3971_i2c_driver);
	553	if (ret != 0)
	554	pr_err("Failed to register I2C driver: %d\n", ret);
	555
	556	return ret;
	557	}
	558	module_init(lp3971_module_init);
	559
	560	static void __exit lp3971_module_exit(void)
	561	{
	562	i2c_del_driver(&lp3971_i2c_driver);
	563	}
	564	module_exit(lp3971_module_exit);
	565
	566	MODULE_LICENSE("GPL");
	567	MODULE_AUTHOR("Marek Szyprowski <m.szyprowski@samsung.com>");
	568	MODULE_DESCRIPTION("LP3971 PMIC driver");