[deliverable/linux.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);
}

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),
	190	LDO_VOL_CONTR_MASK << LDO_VOL_CONTR_SHIFT(ldo), val);
	191	}
	192
	193	static struct regulator_ops lp3971_ldo_ops = {
	194	.list_voltage = lp3971_ldo_list_voltage,
	195	.is_enabled = lp3971_ldo_is_enabled,
	196	.enable = lp3971_ldo_enable,
	197	.disable = lp3971_ldo_disable,
	198	.get_voltage = lp3971_ldo_get_voltage,
	199	.set_voltage = lp3971_ldo_set_voltage,
	200	};
	201
	202	static int lp3971_dcdc_list_voltage(struct regulator_dev *dev, unsigned index)
	203	{
	204	return 1000 * buck_voltage_map[index];
	205	}
	206
	207	static int lp3971_dcdc_is_enabled(struct regulator_dev *dev)
	208	{
	209	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	210	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	211	u16 mask = 1 << (buck * 2);
	212	u16 val;
	213
	214	val = lp3971_reg_read(lp3971, LP3971_BUCK_VOL_ENABLE_REG);
	215	return (val & mask) != 0;
	216	}
	217
	218	static int lp3971_dcdc_enable(struct regulator_dev *dev)
	219	{
	220	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	221	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	222	u16 mask = 1 << (buck * 2);
	223
	224	return lp3971_set_bits(lp3971, LP3971_BUCK_VOL_ENABLE_REG, mask, mask);
	225	}
	226
	227	static int lp3971_dcdc_disable(struct regulator_dev *dev)
	228	{
	229	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	230	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	231	u16 mask = 1 << (buck * 2);
	232
	233	return lp3971_set_bits(lp3971, LP3971_BUCK_VOL_ENABLE_REG, mask, 0);
	234	}
	235
	236	static int lp3971_dcdc_get_voltage(struct regulator_dev *dev)
	237	{
	238	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
	239	int buck = rdev_get_id(dev) - LP3971_DCDC1;
	240	u16 reg;
	241	int val;
	242
	243	reg = lp3971_reg_read(lp3971, LP3971_BUCK_TARGET_VOL1_REG(buck));
	244	reg &= BUCK_TARGET_VOL_MASK;
	245
	246	if (reg <= BUCK_TARGET_VOL_MAX_IDX)
	247	val = 1000 * buck_voltage_map[reg];
	248	else {
	249	val = 0;
	250	dev_warn(&dev->dev, "chip reported incorrect voltage value.\n");
251	}
252
253	return val;
254	}
255
256	static int lp3971_dcdc_set_voltage(struct regulator_dev *dev,
257	int min_uV, int max_uV)
258	{
259	struct lp3971 *lp3971 = rdev_get_drvdata(dev);
260	int buck = rdev_get_id(dev) - LP3971_DCDC1;
261	int min_vol = min_uV / 1000, max_vol = max_uV / 1000;
262	const int *vol_map = buck_voltage_map;
263	u16 val;
264	int ret;
265
266	if (min_vol < vol_map[BUCK_TARGET_VOL_MIN_IDX] \|\|
267	min_vol > vol_map[BUCK_TARGET_VOL_MAX_IDX])
268	return -EINVAL;
269
270	for (val = BUCK_TARGET_VOL_MIN_IDX; val <= BUCK_TARGET_VOL_MAX_IDX;
271	val++)
272	if (vol_map[val] >= min_vol)
273	break;
274
62737d44	275	if (val > BUCK_TARGET_VOL_MAX_IDX \|\| vol_map[val] > max_vol)
0cbdf7bc MS	276	return -EINVAL;
	277
	278	ret = lp3971_set_bits(lp3971, LP3971_BUCK_TARGET_VOL1_REG(buck),
	279	BUCK_TARGET_VOL_MASK, val);
	280	if (ret)
	281	return ret;
	282
	283	ret = lp3971_set_bits(lp3971, LP3971_BUCK_VOL_CHANGE_REG,
	284	BUCK_VOL_CHANGE_FLAG_MASK << BUCK_VOL_CHANGE_SHIFT(buck),
	285	BUCK_VOL_CHANGE_FLAG_GO << BUCK_VOL_CHANGE_SHIFT(buck));
	286	if (ret)
	287	return ret;
	288
	289	return lp3971_set_bits(lp3971, LP3971_BUCK_VOL_CHANGE_REG,
	290	BUCK_VOL_CHANGE_FLAG_MASK << BUCK_VOL_CHANGE_SHIFT(buck),
	291	0 << BUCK_VOL_CHANGE_SHIFT(buck));
	292	}
	293
	294	static struct regulator_ops lp3971_dcdc_ops = {
	295	.list_voltage = lp3971_dcdc_list_voltage,
	296	.is_enabled = lp3971_dcdc_is_enabled,
	297	.enable = lp3971_dcdc_enable,
	298	.disable = lp3971_dcdc_disable,
	299	.get_voltage = lp3971_dcdc_get_voltage,
	300	.set_voltage = lp3971_dcdc_set_voltage,
	301	};
	302
	303	static struct regulator_desc regulators[] = {
	304	{
	305	.name = "LDO1",
	306	.id = LP3971_LDO1,
	307	.ops = &lp3971_ldo_ops,
	308	.n_voltages = ARRAY_SIZE(ldo123_voltage_map),
	309	.type = REGULATOR_VOLTAGE,
	310	.owner = THIS_MODULE,
	311	},
	312	{
	313	.name = "LDO2",
	314	.id = LP3971_LDO2,
	315	.ops = &lp3971_ldo_ops,
	316	.n_voltages = ARRAY_SIZE(ldo123_voltage_map),
	317	.type = REGULATOR_VOLTAGE,
	318	.owner = THIS_MODULE,
	319	},
	320	{
	321	.name = "LDO3",
	322	.id = LP3971_LDO3,
	323	.ops = &lp3971_ldo_ops,
	324	.n_voltages = ARRAY_SIZE(ldo123_voltage_map),
	325	.type = REGULATOR_VOLTAGE,
	326	.owner = THIS_MODULE,
	327	},
	328	{
	329	.name = "LDO4",
	330	.id = LP3971_LDO4,
	331	.ops = &lp3971_ldo_ops,
	332	.n_voltages = ARRAY_SIZE(ldo45_voltage_map),
	333	.type = REGULATOR_VOLTAGE,
	334	.owner = THIS_MODULE,
	335	},
	336	{
	337	.name = "LDO5",
	338	.id = LP3971_LDO5,
	339	.ops = &lp3971_ldo_ops,
340	.n_voltages = ARRAY_SIZE(ldo45_voltage_map),
341	.type = REGULATOR_VOLTAGE,
342	.owner = THIS_MODULE,
343	},
344	{
345	.name = "DCDC1",
346	.id = LP3971_DCDC1,
347	.ops = &lp3971_dcdc_ops,
348	.n_voltages = ARRAY_SIZE(buck_voltage_map),
349	.type = REGULATOR_VOLTAGE,
350	.owner = THIS_MODULE,
351	},
352	{
353	.name = "DCDC2",
354	.id = LP3971_DCDC2,
355	.ops = &lp3971_dcdc_ops,
356	.n_voltages = ARRAY_SIZE(buck_voltage_map),
357	.type = REGULATOR_VOLTAGE,
358	.owner = THIS_MODULE,
359	},
360	{
361	.name = "DCDC3",
362	.id = LP3971_DCDC3,
363	.ops = &lp3971_dcdc_ops,
364	.n_voltages = ARRAY_SIZE(buck_voltage_map),
365	.type = REGULATOR_VOLTAGE,
366	.owner = THIS_MODULE,
367	},
368	};
369
370	static int lp3971_i2c_read(struct i2c_client *i2c, char reg, int count,
371	u16 *dest)
372	{
373	int ret;
374
375	if (count != 1)
376	return -EIO;
377	ret = i2c_smbus_read_byte_data(i2c, reg);
378	if (ret < 0 \|\| count != 1)
379	return -EIO;
380
381	*dest = ret;
382	return 0;
383	}
384
385	static int lp3971_i2c_write(struct i2c_client *i2c, char reg, int count,
386	const u16 *src)
387	{
388	int ret;
389
390	if (count != 1)
391	return -EIO;
392	ret = i2c_smbus_write_byte_data(i2c, reg, *src);
393	if (ret >= 0)
394	return 0;
395
396	return ret;
397	}
398
399	static u8 lp3971_reg_read(struct lp3971 *lp3971, u8 reg)
400	{
401	u16 val = 0;
402
403	mutex_lock(&lp3971->io_lock);
404
405	lp3971_i2c_read(lp3971->i2c, reg, 1, &val);
406
407	dev_dbg(lp3971->dev, "reg read 0x%02x -> 0x%02x\n", (int)reg,
408	(unsigned)val&0xff);
409
410	mutex_unlock(&lp3971->io_lock);
411
412	return val & 0xff;
413	}
414
415	static int lp3971_set_bits(struct lp3971 *lp3971, u8 reg, u16 mask, u16 val)
416	{
417	u16 tmp;
418	int ret;
419
420	mutex_lock(&lp3971->io_lock);
421
422	ret = lp3971_i2c_read(lp3971->i2c, reg, 1, &tmp);
423	tmp = (tmp & ~mask) \| val;
424	if (ret == 0) {
425	ret = lp3971_i2c_write(lp3971->i2c, reg, 1, &tmp);
426	dev_dbg(lp3971->dev, "reg write 0x%02x -> 0x%02x\n", (int)reg,
427	(unsigned)val&0xff);
428	}
429	mutex_unlock(&lp3971->io_lock);
430
431	return ret;
432	}
433
ebbed04f DT	434	static int __devinit setup_regulators(struct lp3971 *lp3971,
ebbed04f DT	435	struct lp3971_platform_data *pdata)
0cbdf7bc MS	436	{
0cbdf7bc MS	437	int i, err;
ebbed04f DT	438
	439	lp3971->num_regulators = pdata->num_regulators;
	440	lp3971->rdev = kcalloc(pdata->num_regulators,
	441	sizeof(struct regulator_dev *), GFP_KERNEL);
67e46f34 DC	442	if (!lp3971->rdev) {
	443	err = -ENOMEM;
	444	goto err_nomem;
	445	}
0cbdf7bc MS	446
0cbdf7bc MS	447	/* Instantiate the regulators */
ebbed04f DT	448	for (i = 0; i < pdata->num_regulators; i++) {
	449	struct lp3971_regulator_subdev *reg = &pdata->regulators[i];
	450	lp3971->rdev[i] = regulator_register(&regulators[reg->id],
	451	lp3971->dev, reg->initdata, lp3971);
0cbdf7bc	452
d662fc82 JL	453	if (IS_ERR(lp3971->rdev[i])) {
d662fc82 JL	454	err = PTR_ERR(lp3971->rdev[i]);
0cbdf7bc MS	455	dev_err(lp3971->dev, "regulator init failed: %d\n",
	456	err);
	457	goto error;
	458	}
	459	}
	460
	461	return 0;
ebbed04f	462
0cbdf7bc	463	error:
ebbed04f DT	464	while (--i >= 0)
ebbed04f DT	465	regulator_unregister(lp3971->rdev[i]);
0cbdf7bc MS	466	kfree(lp3971->rdev);
0cbdf7bc MS	467	lp3971->rdev = NULL;
67e46f34	468	err_nomem:
0cbdf7bc MS	469	return err;
	470	}
	471
	472	static int __devinit lp3971_i2c_probe(struct i2c_client *i2c,
	473	const struct i2c_device_id *id)
	474	{
	475	struct lp3971 *lp3971;
	476	struct lp3971_platform_data *pdata = i2c->dev.platform_data;
	477	int ret;
	478	u16 val;
	479
ebbed04f DT	480	if (!pdata) {
	481	dev_dbg(&i2c->dev, "No platform init data supplied\n");
	482	return -ENODEV;
0cbdf7bc MS	483	}
0cbdf7bc MS	484
ebbed04f DT	485	lp3971 = kzalloc(sizeof(struct lp3971), GFP_KERNEL);
	486	if (lp3971 == NULL)
	487	return -ENOMEM;
	488
0cbdf7bc MS	489	lp3971->i2c = i2c;
0cbdf7bc MS	490	lp3971->dev = &i2c->dev;
0cbdf7bc MS	491
	492	mutex_init(&lp3971->io_lock);
	493
	494	/* Detect LP3971 */
	495	ret = lp3971_i2c_read(i2c, LP3971_SYS_CONTROL1_REG, 1, &val);
	496	if (ret == 0 && (val & SYS_CONTROL1_INIT_MASK) != SYS_CONTROL1_INIT_VAL)
	497	ret = -ENODEV;
	498	if (ret < 0) {
	499	dev_err(&i2c->dev, "failed to detect device\n");
	500	goto err_detect;
	501	}
	502
ebbed04f DT	503	ret = setup_regulators(lp3971, pdata);
	504	if (ret < 0)
	505	goto err_detect;
0cbdf7bc	506
ebbed04f	507	i2c_set_clientdata(i2c, lp3971);
0cbdf7bc MS	508	return 0;
	509
	510	err_detect:
0cbdf7bc	511	kfree(lp3971);
0cbdf7bc MS	512	return ret;
	513	}
	514
	515	static int __devexit lp3971_i2c_remove(struct i2c_client *i2c)
	516	{
	517	struct lp3971 *lp3971 = i2c_get_clientdata(i2c);
	518	int i;
ebbed04f DT	519
	520	i2c_set_clientdata(i2c, NULL);
	521
0cbdf7bc	522	for (i = 0; i < lp3971->num_regulators; i++)
ebbed04f DT	523	regulator_unregister(lp3971->rdev[i]);
ebbed04f DT	524
0cbdf7bc	525	kfree(lp3971->rdev);
0cbdf7bc MS	526	kfree(lp3971);
	527
	528	return 0;
	529	}
	530
	531	static const struct i2c_device_id lp3971_i2c_id[] = {
	532	{ "lp3971", 0 },
	533	{ }
	534	};
	535	MODULE_DEVICE_TABLE(i2c, lp3971_i2c_id);
	536
	537	static struct i2c_driver lp3971_i2c_driver = {
	538	.driver = {
	539	.name = "LP3971",
	540	.owner = THIS_MODULE,
	541	},
	542	.probe = lp3971_i2c_probe,
6113c3a5	543	.remove = __devexit_p(lp3971_i2c_remove),
0cbdf7bc MS	544	.id_table = lp3971_i2c_id,
	545	};
	546
	547	static int __init lp3971_module_init(void)
	548	{
12a1d933	549	int ret;
0cbdf7bc MS	550
	551	ret = i2c_add_driver(&lp3971_i2c_driver);
	552	if (ret != 0)
	553	pr_err("Failed to register I2C driver: %d\n", ret);
	554
	555	return ret;
	556	}
	557	module_init(lp3971_module_init);
	558
	559	static void __exit lp3971_module_exit(void)
	560	{
	561	i2c_del_driver(&lp3971_i2c_driver);
	562	}
	563	module_exit(lp3971_module_exit);
	564
	565	MODULE_LICENSE("GPL");
	566	MODULE_AUTHOR("Marek Szyprowski <m.szyprowski@samsung.com>");
	567	MODULE_DESCRIPTION("LP3971 PMIC driver");