[ARM] tps6591x: Adding regulator and mfd driver

Adding regulator and mfd core driver for TI TPS6591x PMIC family.

Original-Change-Id: I65c0e4758094f211f7e9f0944423bd935c1893c4
Reviewed-on: http://git-master/r/16529
Reviewed-by: Scott Williams <scwilliams@nvidia.com>
Tested-by: Scott Williams <scwilliams@nvidia.com>
Original-Change-Id: I2f82c178e3db0998e7c1a5a3b6b8e49832deaf59

Rebase-Id: Rc23fcc1e98e212ae6dc61a2458cafa016442b441

1 files changed, 597 insertions, 0 deletions

diff --git a/drivers/regulator/tps6591x-regulator.c b/drivers/regulator/tps6591x-regulator.c
new file mode 100755
index 000000000000..89fcbf9301e9
--- /dev/null
+++ b/drivers/regulator/tps6591x-regulator.c
@@ -0,0 +1,597 @@
+/*
+ * driver/regulator/tps6591x-regulator.c
+ *
+ * Regulator driver for TI TPS6591x PMIC family
+ *
+ * Copyright (C) 2011 NVIDIA Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
+ *
+ */
+
+#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/tps6591x.h>
+
+/* supply control and voltage setting  */
+#define TPS6591X_VIO_ADD		0x20
+#define TPS6591X_VDD1_ADD		0x21
+#define TPS6591X_VDD1_OP_ADD		0x22
+#define TPS6591X_VDD1_SR_ADD		0x23
+#define TPS6591X_VDD2_ADD		0x24
+#define TPS6591X_VDD2_OP_ADD		0x25
+#define TPS6591X_VDD2_SR_ADD		0x26
+#define TPS6591X_VDDCTRL_ADD		0x27
+#define TPS6591X_VDDCTRL_OP_ADD		0x28
+#define TPS6591X_VDDCTRL_SR_ADD		0x29
+#define TPS6591X_LDO1_ADD		0x30
+#define TPS6591X_LDO2_ADD		0x31
+#define TPS6591X_LDO3_ADD		0x37
+#define TPS6591X_LDO4_ADD		0x36
+#define TPS6591X_LDO5_ADD		0x32
+#define TPS6591X_LDO6_ADD		0x35
+#define TPS6591X_LDO7_ADD		0x34
+#define TPS6591X_LDO8_ADD		0x33
+#define TPS6591X_INVALID_ADD		0xFF
+
+struct tps6591x_register_info {
+	unsigned char addr;
+	unsigned char nbits;
+	unsigned char shift_bits;
+};
+
+enum {
+	supply_type_none = 0x0,
+	supply_type_single_reg,
+	supply_type_sr_op_reg
+};
+
+struct tps6591x_regulator {
+	struct regulator_desc desc;
+	int supply_type;
+
+	struct tps6591x_register_info supply_reg;
+	struct tps6591x_register_info op_reg;
+	struct tps6591x_register_info sr_reg;
+
+	int *voltages;
+};
+
+static inline struct device *to_tps6591x_dev(struct regulator_dev *rdev)
+{
+	return rdev_get_dev(rdev)->parent->parent;
+}
+
+static int __tps6591x_vio_set_voltage(struct device *parent,
+				      struct tps6591x_regulator *ri,
+				      int min_uV, int max_uV)
+{
+	int uV;
+	uint8_t mask;
+	uint8_t val;
+
+	for (val = 0; val < ri->desc.n_voltages; val++) {
+		uV = ri->voltages[val] * 1000;
+
+		/* use the first in-range value */
+		if (min_uV <= uV && uV <= max_uV) {
+
+			val <<= ri->supply_reg.shift_bits;
+			mask = ((1 << ri->supply_reg.nbits) - 1) <<
+					ri->supply_reg.shift_bits;
+
+			return tps6591x_update(parent, ri->supply_reg.addr,
+					val, mask);
+		}
+	}
+
+	return -EINVAL;
+}
+
+static int tps6591x_vio_set_voltage(struct regulator_dev *rdev,
+				    int min_uV, int max_uV)
+{
+	struct tps6591x_regulator *ri = rdev_get_drvdata(rdev);
+	struct device *parent = to_tps6591x_dev(rdev);
+
+	return __tps6591x_vio_set_voltage(parent, ri, min_uV, max_uV);
+}
+
+static int tps6591x_vio_get_voltage(struct regulator_dev *rdev)
+{
+	struct tps6591x_regulator *ri = rdev_get_drvdata(rdev);
+	struct device *parent = to_tps6591x_dev(rdev);
+	uint8_t val, mask;
+	int ret;
+
+	ret = tps6591x_read(parent, ri->supply_reg.addr, &val);
+	if (ret)
+		return ret;
+
+	mask = ((1 << ri->supply_reg.nbits) - 1) << ri->supply_reg.shift_bits;
+	val = (val & mask) >> ri->supply_reg.shift_bits;
+
+	if (val >= ri->desc.n_voltages)
+		BUG();
+
+	return ri->voltages[val] * 1000;
+}
+
+
+static int tps6591x_ldo_list_voltage(struct regulator_dev *rdev,
+				     unsigned selector)
+{
+	struct tps6591x_regulator *info = rdev_get_drvdata(rdev);
+
+	return info->voltages[selector] * 1000;
+}
+
+static int __tps6591x_ldo1_set_voltage(struct device *parent,
+				      struct tps6591x_regulator *ri,
+				      int min_uV, int max_uV)
+{
+	int val, uV;
+	uint8_t mask;
+
+	for (val = 0; val < ri->desc.n_voltages; val++) {
+		uV = ri->voltages[val] * 1000;
+
+		/* use the first in-range value */
+		if (min_uV <= uV && uV <= max_uV) {
+			val += 4;
+			val <<= ri->supply_reg.shift_bits;
+			mask = ((1 << ri->supply_reg.nbits) - 1) <<
+					ri->supply_reg.shift_bits;
+
+			return tps6591x_update(parent, ri->supply_reg.addr,
+					val, mask);
+		}
+	}
+
+	return -EINVAL;
+}
+
+static int tps6591x_ldo1_set_voltage(struct regulator_dev *rdev,
+				    int min_uV, int max_uV)
+{
+	struct tps6591x_regulator *ri = rdev_get_drvdata(rdev);
+	struct device *parent = to_tps6591x_dev(rdev);
+
+	return __tps6591x_ldo1_set_voltage(parent, ri, min_uV, max_uV);
+}
+
+static int tps6591x_ldo1_get_voltage(struct regulator_dev *rdev)
+{
+	struct tps6591x_regulator *ri = rdev_get_drvdata(rdev);
+	struct device *parent = to_tps6591x_dev(rdev);
+	uint8_t val, mask;
+	int ret;
+
+	ret = tps6591x_read(parent, ri->supply_reg.addr, &val);
+	if (ret)
+		return ret;
+
+	mask = ((1 << ri->supply_reg.nbits) - 1) << ri->supply_reg.shift_bits;
+	val = (val & mask) >> ri->supply_reg.shift_bits;
+
+	if (val < 4)
+		return 1000 * 1000;
+	else if (val > 0x32)
+		return 3300 * 1000;
+	else
+		val -= 4;
+	if (val >= ri->desc.n_voltages)
+		BUG();
+
+	return ri->voltages[val] * 1000;
+}
+
+static int __tps6591x_ldo3_set_voltage(struct device *parent,
+		struct tps6591x_regulator *ri, int min_uV, int max_uV)
+{
+	int val, uV;
+	uint8_t mask;
+
+	for (val = 0; val < ri->desc.n_voltages; val++) {
+		uV = ri->voltages[val] * 1000;
+
+		/* use the first in-range value */
+		if (min_uV <= uV && uV <= max_uV) {
+			val += 2;
+			val <<= ri->supply_reg.shift_bits;
+			mask = ((1 << ri->supply_reg.nbits) - 1) <<
+						ri->supply_reg.shift_bits;
+
+			return tps6591x_update(parent, ri->supply_reg.addr,
+					val, mask);
+		}
+	}
+
+	return -EINVAL;
+}
+
+static int tps6591x_ldo3_set_voltage(struct regulator_dev *rdev,
+				    int min_uV, int max_uV)
+{
+	struct tps6591x_regulator *ri = rdev_get_drvdata(rdev);
+	struct device *parent = to_tps6591x_dev(rdev);
+
+	return __tps6591x_ldo3_set_voltage(parent, ri, min_uV, max_uV);
+}
+
+static int tps6591x_ldo3_get_voltage(struct regulator_dev *rdev)
+{
+	struct tps6591x_regulator *ri = rdev_get_drvdata(rdev);
+	struct device *parent = to_tps6591x_dev(rdev);
+	uint8_t val, mask;
+	int ret;
+
+	ret = tps6591x_read(parent, ri->supply_reg.addr, &val);
+	if (ret)
+		return ret;
+
+	mask = ((1 << ri->supply_reg.nbits) - 1) << ri->supply_reg.shift_bits;
+	val = (val & mask) >> ri->supply_reg.shift_bits;
+
+	if (val < 2)
+		return 1000 * 1000;
+	else if (val > 0x19)
+		return 3300 * 1000;
+	else
+		val -= 2;
+	if (val >= ri->desc.n_voltages)
+		BUG();
+
+	return ri->voltages[val] * 1000;
+}
+
+static int __tps6591x_vdd_set_voltage(struct device *parent,
+				      struct tps6591x_regulator *ri,
+				      int min_uV, int max_uV)
+{
+	int val, uV, ret;
+	uint8_t mask, reg_val;
+
+	for (val = 0; val < ri->desc.n_voltages; val++) {
+		uV = ri->voltages[val] * 1000;
+
+		/* use the first in-range value */
+		if (min_uV <= uV && uV <= max_uV) {
+			ret = tps6591x_read(parent, ri->op_reg.addr, &reg_val);
+			if (ret)
+				return ret;
+			val += 3;
+			if (reg_val & 0x80) {
+				val <<= ri->sr_reg.shift_bits;
+				mask = ((1 << ri->sr_reg.nbits) - 1)
+					<< ri->sr_reg.shift_bits;
+				return tps6591x_update(parent,
+					ri->sr_reg.addr, val, mask);
+			} else {
+				val <<= ri->op_reg.shift_bits;
+				mask = ((1 << ri->op_reg.nbits) - 1)
+					<< ri->op_reg.shift_bits;
+				return tps6591x_update(parent,
+					ri->op_reg.addr, val, mask);
+			}
+		}
+	}
+
+	return -EINVAL;
+}
+
+static int tps6591x_vdd_set_voltage(struct regulator_dev *rdev,
+				    int min_uV, int max_uV)
+{
+	struct tps6591x_regulator *ri = rdev_get_drvdata(rdev);
+	struct device *parent = to_tps6591x_dev(rdev);
+
+	return __tps6591x_vdd_set_voltage(parent, ri, min_uV, max_uV);
+}
+
+static int tps6591x_vdd_get_voltage(struct regulator_dev *rdev)
+{
+	struct tps6591x_regulator *ri = rdev_get_drvdata(rdev);
+	struct device *parent = to_tps6591x_dev(rdev);
+	uint8_t op_val, sr_val, val;
+	int ret;
+
+	ret = tps6591x_read(parent, ri->op_reg.addr, &op_val);
+	if (ret)
+		return ret;
+
+	ret = tps6591x_read(parent, ri->sr_reg.addr, &sr_val);
+	if (ret)
+		return ret;
+
+	val = (op_val & 0x80) ? (sr_val & 0x7F) : (op_val & 0x7F);
+
+	if (!val)
+		return 0;
+	else if (val < 0x3)
+		return 600 * 1000;
+	else if (val > 0x4B)
+		return 1500 * 1000;
+	else
+		val -= 3;
+
+	if (val >= ri->desc.n_voltages)
+		BUG();
+
+	return ri->voltages[val] * 1000;
+}
+
+static int tps6591x_regulator_enable(struct regulator_dev *rdev)
+{
+	struct tps6591x_regulator *ri = rdev_get_drvdata(rdev);
+	struct device *parent = to_tps6591x_dev(rdev);
+
+	return tps6591x_set_bits(parent, ri->supply_reg.addr, 0x1);
+}
+
+static int tps6591x_regulator_disable(struct regulator_dev *rdev)
+{
+	struct tps6591x_regulator *ri = rdev_get_drvdata(rdev);
+	struct device *parent = to_tps6591x_dev(rdev);
+
+	return tps6591x_clr_bits(parent, ri->supply_reg.addr, 0x1);
+}
+
+static int tps6591x_regulator_is_enabled(struct regulator_dev *rdev)
+{
+	struct tps6591x_regulator *ri = rdev_get_drvdata(rdev);
+	struct device *parent = to_tps6591x_dev(rdev);
+	uint8_t reg_val;
+	int ret;
+
+	ret = tps6591x_read(parent, ri->supply_reg.addr, &reg_val);
+	if (ret)
+		return ret;
+
+	return !!(reg_val & 0x1);
+}
+
+static struct regulator_ops tps6591x_regulator_vio_ops = {
+	.list_voltage = tps6591x_ldo_list_voltage,
+	.get_voltage = tps6591x_vio_get_voltage,
+	.set_voltage = tps6591x_vio_set_voltage,
+
+	.is_enabled = tps6591x_regulator_is_enabled,
+	.enable = tps6591x_regulator_enable,
+	.disable = tps6591x_regulator_disable,
+};
+
+static struct regulator_ops tps6591x_regulator_ldo1_ops = {
+	.list_voltage = tps6591x_ldo_list_voltage,
+	.get_voltage = tps6591x_ldo1_get_voltage,
+	.set_voltage = tps6591x_ldo1_set_voltage,
+
+	.is_enabled = tps6591x_regulator_is_enabled,
+	.enable = tps6591x_regulator_enable,
+	.disable = tps6591x_regulator_disable,
+};
+
+static struct regulator_ops tps6591x_regulator_ldo3_ops = {
+	.list_voltage = tps6591x_ldo_list_voltage,
+	.get_voltage = tps6591x_ldo3_get_voltage,
+	.set_voltage = tps6591x_ldo3_set_voltage,
+
+	.is_enabled = tps6591x_regulator_is_enabled,
+	.enable = tps6591x_regulator_enable,
+	.disable = tps6591x_regulator_disable,
+};
+
+static struct regulator_ops tps6591x_regulator_vdd_ops = {
+	.list_voltage = tps6591x_ldo_list_voltage,
+	.get_voltage = tps6591x_vdd_get_voltage,
+	.set_voltage = tps6591x_vdd_set_voltage,
+
+	.is_enabled = tps6591x_regulator_is_enabled,
+	.enable = tps6591x_regulator_enable,
+	.disable = tps6591x_regulator_disable,
+};
+
+static int tps6591x_vio_voltages[] = {
+	1500, 1800, 2500, 3300,
+};
+
+/* SEL[7:2]=000100:1000mV --> 110010:3300mV */
+static int tps6591x_ldo124_voltages[] = {
+	1000, 1050, 1100, 1150, 1200, 1250, 1300, 1350, 1400, 1450,
+	1500, 1550, 1600, 1650, 1700, 1750, 1800, 1850, 1900, 1950,
+	2000, 2050, 2100, 2150, 2200, 2250, 2300, 2350, 2400, 2450,
+	2500, 2550, 2600, 2650, 2700, 2750, 2800, 2850, 2900, 2950,
+	3000, 3050, 3100, 3150, 3200, 3250, 3300,
+};
+
+/* SEL[6:2]=00010:1000mv --> 11001:3300mV */
+static int tps6591x_ldo35678_voltages[] = {
+	1000, 1100, 1200, 1300, 1400, 1500, 1600, 1700, 1800, 1900,
+	2000, 2100, 2200, 2300, 2400, 2500, 2600, 2700, 2800, 2900,
+	3000, 3100, 3200, 3300,
+};
+
+static int tps6591x_vdd_voltages[] = {
+	600, 612, 625, 637, 650, 662, 675, 687, 700, 712, 725, 737,
+	750, 762, 775, 787, 800, 812, 825, 837, 850, 862, 875, 887,
+	900, 912, 925, 937, 950, 962, 975, 987, 1000, 1012, 1025,
+	1037, 1050, 1062, 1075, 1087, 1100, 1112, 1125, 1137, 1150,
+	1162, 1175, 1187, 1200, 1212, 1225, 1237, 1250, 1262, 1275,
+	1287, 1300, 1312, 1325, 1337, 1350, 1362, 1375, 1387, 1400,
+	1412, 1425, 1437, 1450, 1462, 1475, 1487, 1500,
+};
+
+#define TPS6591X_REGULATOR(_id, vdata, _ops, s_addr, s_nbits, s_shift,	\
+			s_type, op_addr, op_nbits, op_shift, sr_addr,	\
+			sr_nbits, sr_shift)				\
+	.desc	= {							\
+		.name	= tps6591x_rails(_id),				\
+		.ops	= &tps6591x_regulator_##_ops,			\
+		.type	= REGULATOR_VOLTAGE,				\
+		.id	= TPS6591X_ID_##_id,				\
+		.n_voltages = ARRAY_SIZE(tps6591x_##vdata##_voltages),	\
+		.owner	= THIS_MODULE,					\
+	},								\
+	.supply_type	= supply_type_##s_type,				\
+	.supply_reg	= {						\
+		.addr	= TPS6591X_##s_addr##_ADD,			\
+		.nbits	= s_nbits,					\
+		.shift_bits = s_shift,					\
+	},								\
+	.op_reg		= {						\
+		.addr	= TPS6591X_##op_addr##_ADD,			\
+		.nbits	= op_nbits,					\
+		.shift_bits = op_shift,					\
+	},								\
+	.sr_reg		= {						\
+		.addr	= TPS6591X_##sr_addr##_ADD,			\
+		.nbits	= sr_nbits,					\
+		.shift_bits = sr_shift,					\
+	},								\
+	.voltages	= tps6591x_##vdata##_voltages,
+
+#define TPS6591X_VIO(_id, vdata, s_addr, s_nbits, s_shift, s_type)	\
+{									\
+	TPS6591X_REGULATOR(_id, vdata, vio_ops, s_addr, s_nbits,	\
+			s_shift, s_type, INVALID, 0, 0,	INVALID, 0, 0)	\
+}
+
+#define TPS6591X_LDO1(_id, vdata, s_addr, s_nbits, s_shift, s_type)	\
+{									\
+	TPS6591X_REGULATOR(_id, vdata, ldo1_ops, s_addr, s_nbits,	\
+			s_shift, s_type, INVALID, 0, 0,	INVALID, 0, 0)	\
+}
+
+#define TPS6591X_LDO3(_id, vdata, s_addr, s_nbits, s_shift, s_type)	\
+{									\
+	TPS6591X_REGULATOR(_id, vdata, ldo3_ops, s_addr, s_nbits,	\
+			s_shift, s_type, INVALID, 0, 0,	INVALID, 0, 0)	\
+}
+
+#define TPS6591X_VDD(_id, vdata, s_addr, s_nbits, s_shift, s_type,	\
+			op_addr, op_nbits, op_shift, sr_addr, sr_nbits,	\
+			sr_shift)					\
+{									\
+	TPS6591X_REGULATOR(_id, vdata, vdd_ops, s_addr, s_nbits,	\
+			s_shift, s_type, op_addr, op_nbits, op_shift,	\
+			sr_addr, sr_nbits, sr_shift)			\
+}
+
+static struct tps6591x_regulator tps6591x_regulator[] = {
+	TPS6591X_VIO(VIO, vio, VIO, 2, 2, single_reg),
+	TPS6591X_LDO1(LDO_1, ldo124, LDO1, 6, 2, single_reg),
+	TPS6591X_LDO1(LDO_2, ldo124, LDO2, 6, 2, single_reg),
+	TPS6591X_LDO3(LDO_3, ldo35678, LDO3, 5, 2, single_reg),
+	TPS6591X_LDO1(LDO_4, ldo124, LDO4, 6, 2, single_reg),
+	TPS6591X_LDO3(LDO_5, ldo35678, LDO5, 5, 2, single_reg),
+	TPS6591X_LDO3(LDO_6, ldo35678, LDO6, 5, 2, single_reg),
+	TPS6591X_LDO3(LDO_7, ldo35678, LDO7, 5, 2, single_reg),
+	TPS6591X_LDO3(LDO_8, ldo35678, LDO8, 5, 2, single_reg),
+	TPS6591X_VDD(VDD_1, vdd, VDD1, 2, 0, sr_op_reg, VDD1_OP,
+		7, 0, VDD1_SR, 7, 0),
+	TPS6591X_VDD(VDD_2, vdd, VDD2, 2, 0, sr_op_reg, VDD2_OP,
+		7, 0, VDD2_SR, 7, 0),
+	TPS6591X_VDD(VDDCTRL, vdd, VDDCTRL, 2, 0, sr_op_reg,
+		VDDCTRL_OP, 7, 0, VDDCTRL_SR, 7, 0),
+};
+
+static inline int tps6591x_regulator_preinit(struct device *parent,
+					     struct tps6591x_regulator *ri)
+{
+	return tps6591x_set_bits(parent, ri->supply_reg.addr, 0x1);
+}
+
+static inline struct tps6591x_regulator *find_regulator_info(int id)
+{
+	struct tps6591x_regulator *ri;
+	int i;
+
+	for (i = 0; i < ARRAY_SIZE(tps6591x_regulator); i++) {
+		ri = &tps6591x_regulator[i];
+		if (ri->desc.id == id)
+			return ri;
+	}
+	return NULL;
+}
+
+static int __devinit tps6591x_regulator_probe(struct platform_device *pdev)
+{
+	struct tps6591x_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 = tps6591x_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_OR_NULL(rdev)) {
+		dev_err(&pdev->dev, "failed to register regulator %s\n",
+				ri->desc.name);
+		return PTR_ERR(rdev);
+	}
+
+	platform_set_drvdata(pdev, rdev);
+
+	return 0;
+}
+
+static int __devexit tps6591x_regulator_remove(struct platform_device *pdev)
+{
+	struct regulator_dev *rdev = platform_get_drvdata(pdev);
+
+	regulator_unregister(rdev);
+	return 0;
+}
+
+static struct platform_driver tps6591x_regulator_driver = {
+	.driver	= {
+		.name	= "tps6591x-regulator",
+		.owner	= THIS_MODULE,
+	},
+	.probe		= tps6591x_regulator_probe,
+	.remove		= __devexit_p(tps6591x_regulator_remove),
+};
+
+static int __init tps6591x_regulator_init(void)
+{
+	return platform_driver_register(&tps6591x_regulator_driver);
+}
+subsys_initcall(tps6591x_regulator_init);
+
+static void __exit tps6591x_regulator_exit(void)
+{
+	platform_driver_unregister(&tps6591x_regulator_driver);
+}
+module_exit(tps6591x_regulator_exit);
+
+MODULE_LICENSE("GPL");
+MODULE_DESCRIPTION("Regulator Driver for TI TPS6591X PMIC");
+MODULE_ALIAS("platform:tps6591x-regulator");