[net-next-2.6.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);

	/* 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;
	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);
0cbdf7bc MS	442
0cbdf7bc MS	443	/* Instantiate the regulators */
ebbed04f DT	444	for (i = 0; i < pdata->num_regulators; i++) {
	445	struct lp3971_regulator_subdev *reg = &pdata->regulators[i];
	446	lp3971->rdev[i] = regulator_register(&regulators[reg->id],
	447	lp3971->dev, reg->initdata, lp3971);
0cbdf7bc	448
d662fc82 JL	449	if (IS_ERR(lp3971->rdev[i])) {
d662fc82 JL	450	err = PTR_ERR(lp3971->rdev[i]);
0cbdf7bc MS	451	dev_err(lp3971->dev, "regulator init failed: %d\n",
	452	err);
	453	goto error;
	454	}
	455	}
	456
	457	return 0;
ebbed04f	458
0cbdf7bc	459	error:
ebbed04f DT	460	while (--i >= 0)
ebbed04f DT	461	regulator_unregister(lp3971->rdev[i]);
0cbdf7bc MS	462	kfree(lp3971->rdev);
	463	lp3971->rdev = NULL;
	464	return err;
	465	}
	466
	467	static int __devinit lp3971_i2c_probe(struct i2c_client *i2c,
	468	const struct i2c_device_id *id)
	469	{
	470	struct lp3971 *lp3971;
	471	struct lp3971_platform_data *pdata = i2c->dev.platform_data;
	472	int ret;
	473	u16 val;
	474
ebbed04f DT	475	if (!pdata) {
	476	dev_dbg(&i2c->dev, "No platform init data supplied\n");
	477	return -ENODEV;
0cbdf7bc MS	478	}
0cbdf7bc MS	479
ebbed04f DT	480	lp3971 = kzalloc(sizeof(struct lp3971), GFP_KERNEL);
	481	if (lp3971 == NULL)
	482	return -ENOMEM;
	483
0cbdf7bc MS	484	lp3971->i2c = i2c;
0cbdf7bc MS	485	lp3971->dev = &i2c->dev;
0cbdf7bc MS	486
	487	mutex_init(&lp3971->io_lock);
	488
	489	/* Detect LP3971 */
	490	ret = lp3971_i2c_read(i2c, LP3971_SYS_CONTROL1_REG, 1, &val);
	491	if (ret == 0 && (val & SYS_CONTROL1_INIT_MASK) != SYS_CONTROL1_INIT_VAL)
	492	ret = -ENODEV;
	493	if (ret < 0) {
	494	dev_err(&i2c->dev, "failed to detect device\n");
	495	goto err_detect;
	496	}
	497
ebbed04f DT	498	ret = setup_regulators(lp3971, pdata);
	499	if (ret < 0)
	500	goto err_detect;
0cbdf7bc	501
ebbed04f	502	i2c_set_clientdata(i2c, lp3971);
0cbdf7bc MS	503	return 0;
	504
	505	err_detect:
0cbdf7bc	506	kfree(lp3971);
0cbdf7bc MS	507	return ret;
	508	}
	509
	510	static int __devexit lp3971_i2c_remove(struct i2c_client *i2c)
	511	{
	512	struct lp3971 *lp3971 = i2c_get_clientdata(i2c);
	513	int i;
ebbed04f DT	514
	515	i2c_set_clientdata(i2c, NULL);
	516
0cbdf7bc	517	for (i = 0; i < lp3971->num_regulators; i++)
ebbed04f DT	518	regulator_unregister(lp3971->rdev[i]);
ebbed04f DT	519
0cbdf7bc	520	kfree(lp3971->rdev);
0cbdf7bc MS	521	kfree(lp3971);
	522
	523	return 0;
	524	}
	525
	526	static const struct i2c_device_id lp3971_i2c_id[] = {
	527	{ "lp3971", 0 },
	528	{ }
	529	};
	530	MODULE_DEVICE_TABLE(i2c, lp3971_i2c_id);
	531
	532	static struct i2c_driver lp3971_i2c_driver = {
	533	.driver = {
	534	.name = "LP3971",
	535	.owner = THIS_MODULE,
	536	},
	537	.probe = lp3971_i2c_probe,
6113c3a5	538	.remove = __devexit_p(lp3971_i2c_remove),
0cbdf7bc MS	539	.id_table = lp3971_i2c_id,
	540	};
	541
	542	static int __init lp3971_module_init(void)
	543	{
12a1d933	544	int ret;
0cbdf7bc MS	545
	546	ret = i2c_add_driver(&lp3971_i2c_driver);
	547	if (ret != 0)
	548	pr_err("Failed to register I2C driver: %d\n", ret);
	549
	550	return ret;
	551	}
	552	module_init(lp3971_module_init);
	553
	554	static void __exit lp3971_module_exit(void)
	555	{
	556	i2c_del_driver(&lp3971_i2c_driver);
	557	}
	558	module_exit(lp3971_module_exit);
	559
	560	MODULE_LICENSE("GPL");
	561	MODULE_AUTHOR("Marek Szyprowski <m.szyprowski@samsung.com>");
	562	MODULE_DESCRIPTION("LP3971 PMIC driver");